Rev 455 | Rev 460 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 455 | Rev 457 | ||
---|---|---|---|
Line 400... | Line 400... | ||
400 | ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; // m/s |
400 | ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; // m/s |
401 | ToFlightCtrl.Param.Int[2] = NaviData.HomePositionDeviation.Distance; // dm //4&5 |
401 | ToFlightCtrl.Param.Int[2] = NaviData.HomePositionDeviation.Distance; // dm //4&5 |
402 | ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing; // deg //6&7 |
402 | ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing; // deg //6&7 |
403 | if(FC_WP_EventChannel > 254) FC_WP_EventChannel = 254; // Muss in SPI_NCCMD_GPSINFO bleiben! (siehe oben) |
403 | if(FC_WP_EventChannel > 254) FC_WP_EventChannel = 254; // Muss in SPI_NCCMD_GPSINFO bleiben! (siehe oben) |
404 | if(FC_WP_EventChannel) LogFC_WP_EventChannel = FC_WP_EventChannel; // to make sure that it will be logged |
404 | if(FC_WP_EventChannel) LogFC_WP_EventChannel = FC_WP_EventChannel; // to make sure that it will be logged |
- | 405 | // ++++++++++++++++++++++++++++++++++ |
|
- | 406 | // Waypoint event +++++++++++++++++++ |
|
- | 407 | // ++++++++++++++++++++++++++++++++++ |
|
- | 408 | if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_WP_EVENT_ONCE, &tmp)) |
|
- | 409 | { |
|
- | 410 | ToFlightCtrl.Param.Byte[8] = (s8)(tmp - 127); |
|
- | 411 | NCParams_ClearValue(NCPARAMS_WP_EVENT_ONCE); |
|
- | 412 | NCParams_ClearValue(NCPARAMS_WP_EVENT_FOREVER); |
|
- | 413 | } |
|
- | 414 | else |
|
- | 415 | if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_WP_EVENT_FOREVER, &tmp)) |
|
- | 416 | { |
|
- | 417 | ToFlightCtrl.Param.Byte[8] = (s8)(tmp - 127); |
|
- | 418 | if(tmp == 0) NCParams_ClearValue(NCPARAMS_WP_EVENT_FOREVER); |
|
- | 419 | } |
|
405 | ToFlightCtrl.Param.Byte[8] = (s8)(FC_WP_EventChannel - 127); |
420 | else ToFlightCtrl.Param.Byte[8] = (s8)(FC_WP_EventChannel - 127); |
406 | FC_WP_EventChannel = 0; // the GPS-Routine will set it again |
421 | FC_WP_EventChannel = 0; // the GPS-Routine will set it again |
- | 422 | // ++++++++++++++++++++++++++++++++++ |
|
407 | if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_ALTITUDE_RATE, &tmp)) |
423 | if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_ALTITUDE_RATE, &tmp)) |
408 | { |
424 | { |
409 | ToFlightCtrl.Param.Byte[9] = (u8)tmp; |
425 | ToFlightCtrl.Param.Byte[9] = (u8)tmp; |
410 | } |
426 | } |
411 | else |
427 | else |