Subversion Repositories NaviCtrl

Rev

Rev 280 | Rev 295 | 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;
294 holgerb 12
        NCParams[NCPARAMS_NEW_CAMERA_ELEVATION] = -30000; // invalid
13
        NCParams[NCPARAMS_ALTITUDE_RATE] = -1;
14
        NCParams[NCPARAMS_ALTITUDE_SETPOINT] = -30000; // in 0,1m     -3000 -> invalid
156 killagreg 15
}
16
 
157 killagreg 17
u8 NCParams_SetValue(u8 id, s16* pvalue)
156 killagreg 18
{
157 killagreg 19
        NCParams[id] = *pvalue;
278 killagreg 20
 
21
        switch(id)
22
        {
23
                case NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT:
280 killagreg 24
                    if(NULL == PointList_GetPOI())
278 killagreg 25
                        {
26
                                CAM_Orientation.Azimuth = *pvalue;
27
                                CAM_Orientation.Elevation = 0;
280 killagreg 28
                                CAM_Orientation.UpdateMask = CAM_UPDATE_AZIMUTH;
278 killagreg 29
                        }
30
                        break;
31
 
32
                default:
33
                        break;
34
        }
156 killagreg 35
        return 1;      
36
}
37
 
157 killagreg 38
u8 NCParams_GetValue(u8 id, s16* pvalue)
156 killagreg 39
{
157 killagreg 40
        if(pvalue == 0) return 0;
41
        *pvalue = NCParams[id];
42
        return 1;
156 killagreg 43
}