Rev 276 | Rev 280 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 276 | Rev 278 | ||
---|---|---|---|
1 | #include "91x_lib.h" |
1 | #include "91x_lib.h" |
2 | #include "params.h" |
2 | #include "params.h" |
3 | #include "spi_slave.h" |
3 | #include "spi_slave.h" |
- | 4 | #include "waypoints.h" |
|
4 | 5 | ||
5 | s16 NCParams[255]; |
6 | s16 NCParams[255]; |
6 | 7 | ||
7 | void NCParams_Init(void) |
8 | void NCParams_Init(void) |
8 | { |
9 | { |
9 | NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s |
10 | NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s |
10 | NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1; |
11 | NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1; |
11 | } |
12 | } |
12 | 13 | ||
13 | u8 NCParams_SetValue(u8 id, s16* pvalue) |
14 | u8 NCParams_SetValue(u8 id, s16* pvalue) |
14 | { |
15 | { |
15 | NCParams[id] = *pvalue; |
16 | NCParams[id] = *pvalue; |
- | 17 | ||
16 | // Process data |
18 | switch(id) |
- | 19 | { |
|
17 | if(id == NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT) NewCompassDirectionSetpoint = NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT]; |
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 | } |
|
18 | return 1; |
32 | return 1; |
19 | } |
33 | } |
20 | 34 | ||
21 | u8 NCParams_GetValue(u8 id, s16* pvalue) |
35 | u8 NCParams_GetValue(u8 id, s16* pvalue) |
22 | { |
36 | { |
23 | if(pvalue == 0) return 0; |
37 | if(pvalue == 0) return 0; |
24 | *pvalue = NCParams[id]; |
38 | *pvalue = NCParams[id]; |
25 | return 1; |
39 | return 1; |
26 | } |
40 | } |
27 | 41 |