Subversion Repositories NaviCtrl

Rev

Rev 455 | Rev 460 | Go to most recent revision | Show entire file | Ignore 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