Subversion Repositories NaviCtrl

Rev

Rev 276 | Rev 280 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
156 killagreg 1
#include "91x_lib.h"
2
#include "params.h"
276 holgerb 3
#include "spi_slave.h"
278 killagreg 4
#include "waypoints.h"
156 killagreg 5
 
6
s16 NCParams[255];
7
 
8
void NCParams_Init(void)
9
{
10
        NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s
276 holgerb 11
        NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1;
156 killagreg 12
}
13
 
157 killagreg 14
u8 NCParams_SetValue(u8 id, s16* pvalue)
156 killagreg 15
{
157 killagreg 16
        NCParams[id] = *pvalue;
278 killagreg 17
 
18
        switch(id)
19
        {
20
                case NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT:
21
                    if(NULL == WPList_GetPOI())
22
                        {
23
                                CAM_Orientation.Azimuth = *pvalue;
24
                                CAM_Orientation.Elevation = 0;
25
                                CAM_Orientation.State = NEWDATA;
26
                        }
27
                        break;
28
 
29
                default:
30
                        break;
31
        }
156 killagreg 32
        return 1;      
33
}
34
 
157 killagreg 35
u8 NCParams_GetValue(u8 id, s16* pvalue)
156 killagreg 36
{
157 killagreg 37
        if(pvalue == 0) return 0;
38
        *pvalue = NCParams[id];
39
        return 1;
156 killagreg 40
}