Rev 276 | Rev 280 | Go to most recent revision | Only display areas with differences | Ignore 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 | ||