Rev 278 | Rev 294 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 278 | Rev 280 | ||
|---|---|---|---|
| 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 | #include "waypoints.h" |
| 5 | 5 | ||
| 6 | s16 NCParams[255]; |
6 | s16 NCParams[255]; |
| 7 | 7 | ||
| 8 | void NCParams_Init(void) |
8 | void NCParams_Init(void) |
| 9 | { |
9 | { |
| 10 | NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s |
10 | NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s |
| 11 | NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1; |
11 | NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1; |
| 12 | } |
12 | } |
| 13 | 13 | ||
| 14 | u8 NCParams_SetValue(u8 id, s16* pvalue) |
14 | u8 NCParams_SetValue(u8 id, s16* pvalue) |
| 15 | { |
15 | { |
| 16 | NCParams[id] = *pvalue; |
16 | NCParams[id] = *pvalue; |
| 17 | 17 | ||
| 18 | switch(id) |
18 | switch(id) |
| 19 | { |
19 | { |
| 20 | case NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT: |
20 | case NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT: |
| 21 | if(NULL == WPList_GetPOI()) |
21 | if(NULL == PointList_GetPOI()) |
| 22 | { |
22 | { |
| 23 | CAM_Orientation.Azimuth = *pvalue; |
23 | CAM_Orientation.Azimuth = *pvalue; |
| 24 | CAM_Orientation.Elevation = 0; |
24 | CAM_Orientation.Elevation = 0; |
| 25 | CAM_Orientation.State = NEWDATA; |
25 | CAM_Orientation.UpdateMask = CAM_UPDATE_AZIMUTH; |
| 26 | } |
26 | } |
| 27 | break; |
27 | break; |
| 28 | 28 | ||
| 29 | default: |
29 | default: |
| 30 | break; |
30 | break; |
| 31 | } |
31 | } |
| 32 | return 1; |
32 | return 1; |
| 33 | } |
33 | } |
| 34 | 34 | ||
| 35 | u8 NCParams_GetValue(u8 id, s16* pvalue) |
35 | u8 NCParams_GetValue(u8 id, s16* pvalue) |
| 36 | { |
36 | { |
| 37 | if(pvalue == 0) return 0; |
37 | if(pvalue == 0) return 0; |
| 38 | *pvalue = NCParams[id]; |
38 | *pvalue = NCParams[id]; |
| 39 | return 1; |
39 | return 1; |
| 40 | } |
40 | } |
| 41 | 41 | ||