Subversion Repositories NaviCtrl

Rev

Rev 294 | Rev 298 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 294 Rev 295
Line 2... Line 2...
2 
#include "params.h"
 2 
#include "params.h"
3 
#include "spi_slave.h"
 3 
#include "spi_slave.h"
4 
#include "waypoints.h"
 4 
#include "waypoints.h"
Line 5... Line 5...
5 
 
 5 
 
- 
 
 6 
s16 NCParams[255];
Line 6... Line 7...
6 
s16 NCParams[255];
 7 
u8 NCParamState[255];
7 
 
 8 
 
- 
 
 9 
void NCParams_Init(void)
- 
 
 10 
{
- 
 
 11 
        u16 i;
- 
 
 12 
        for(i=0; i<256; i++)
- 
 
 13 
        {
8 
void NCParams_Init(void)
 14 
                NCParamState[i] = NCPARAM_STATE_UNDEFINED;
9 
{
 15 
        }
10 
        NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s
 - 
 
11 
        NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1;
 16 
        NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s
12 
        NCParams[NCPARAMS_NEW_CAMERA_ELEVATION] = -30000; // invalid
 - 
 
13 
        NCParams[NCPARAMS_ALTITUDE_RATE] = -1;
 17 
        NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1;
Line 14... Line 18...
14 
        NCParams[NCPARAMS_ALTITUDE_SETPOINT] = -30000; // in 0,1m     -3000 -> invalid
 18 
        NCParams[NCPARAMS_ALTITUDE_RATE] = -1;
15 
}
 19 
}
16 
 
 20 
 
- 
 
 21 
u8 NCParams_SetValue(u8 id, s16* pvalue)
Line 17... Line 22...
17 
u8 NCParams_SetValue(u8 id, s16* pvalue)
 22 
{
18 
{
 23 
        NCParams[id] = *pvalue;
19 
        NCParams[id] = *pvalue;
 24 
        NCParamState[id] =      NCRARAM_STATE_VALID;
20 
 
 25 
 
Line 30... Line 35...
30 
                        break;
 35 
                        break;
Line 31... Line 36...
31 
 
 36 
 
32 
                default:
 37 
                default:
33 
                        break;
 38 
                        break;
34 
        }
 39 
        }
35 
        return 1;      
 40 
        return NCParamState[id];
Line 36... Line 41...
36 
}
 41 
}
37 
 
 42 
 
38 
u8 NCParams_GetValue(u8 id, s16* pvalue)
 43 
u8 NCParams_GetValue(u8 id, s16* pvalue)
- 
 
 44 
{
- 
 
 45 
        if(pvalue == 0) return 0;
39 
{
 46 
        if(NCParamState[id] == NCRARAM_STATE_VALID)
- 
 
 47 
        {
40 
        if(pvalue == 0) return 0;
 48 
                *pvalue = NCParams[id];
41 
        *pvalue = NCParams[id];
 49 
        }