コード例 #1
0
ファイル: stabilization.c プロジェクト: CodeMining/LibrePilot 
/**
 * Module initialization
 */
int32_t StabilizationStart()
{
    StabilizationSettingsConnectCallback(SettingsUpdatedCb);
    ManualControlCommandConnectCallback(FlightModeSwitchUpdatedCb);
    StabilizationBankConnectCallback(BankUpdatedCb);
    StabilizationSettingsBank1ConnectCallback(SettingsBankUpdatedCb);
    StabilizationSettingsBank2ConnectCallback(SettingsBankUpdatedCb);
    StabilizationSettingsBank3ConnectCallback(SettingsBankUpdatedCb);
    StabilizationDesiredConnectCallback(StabilizationDesiredUpdatedCb);
    SettingsUpdatedCb(StabilizationSettingsHandle());
    StabilizationDesiredUpdatedCb(StabilizationDesiredHandle());
    FlightModeSwitchUpdatedCb(ManualControlCommandHandle());
    BankUpdatedCb(StabilizationBankHandle());

#ifdef PIOS_INCLUDE_WDG
    PIOS_WDG_RegisterFlag(PIOS_WDG_STABILIZATION);
#endif
    return 0;
}
コード例 #2
0
void StabilizationBankThrustPIDScaleTargetSet(uint8_t *NewThrustPIDScaleTarget)
{
    UAVObjSetDataField(StabilizationBankHandle(), (void *)NewThrustPIDScaleTarget, offsetof(StabilizationBankData, ThrustPIDScaleTarget), sizeof(uint8_t));
}
コード例 #3
0
void StabilizationBankEnableThrustPIDScalingGet(uint8_t *NewEnableThrustPIDScaling)
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewEnableThrustPIDScaling, offsetof(StabilizationBankData, EnableThrustPIDScaling), sizeof(uint8_t));
}
コード例 #4
0
void StabilizationBankEnablePiroCompGet(uint8_t *NewEnablePiroComp)
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewEnablePiroComp, offsetof(StabilizationBankData, EnablePiroComp), sizeof(uint8_t));
}
コード例 #5
0
void StabilizationBankStickExpoArrayGet( int8_t *NewStickExpo )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewStickExpo, offsetof(StabilizationBankData, StickExpo), 3*sizeof(int8_t));
}
コード例 #6
0
void StabilizationBankYawMaxGet(uint8_t *NewYawMax)
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewYawMax, offsetof(StabilizationBankData, YawMax), sizeof(uint8_t));
}
コード例 #7
0
void StabilizationBankPitchMaxSet(uint8_t *NewPitchMax)
{
    UAVObjSetDataField(StabilizationBankHandle(), (void *)NewPitchMax, offsetof(StabilizationBankData, PitchMax), sizeof(uint8_t));
}
コード例 #8
0
void StabilizationBankMaximumRateArrayGet( float *NewMaximumRate )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewMaximumRate, offsetof(StabilizationBankData, MaximumRate), 3*sizeof(float));
}
コード例 #9
0
void StabilizationBankAcroInsanityFactorGet(float *NewAcroInsanityFactor)
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewAcroInsanityFactor, offsetof(StabilizationBankData, AcroInsanityFactor), sizeof(float));
}
コード例 #10
0
void StabilizationBankYawPIArrayGet( float *NewYawPI )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewYawPI, offsetof(StabilizationBankData, YawPI), 3*sizeof(float));
}
コード例 #11
0
void StabilizationBankPitchPIArraySet( float *NewPitchPI )
{
    UAVObjSetDataField(StabilizationBankHandle(), (void *)NewPitchPI, offsetof(StabilizationBankData, PitchPI), 3*sizeof(float));
}
コード例 #12
0
void StabilizationBankRollPIGet( StabilizationBankRollPIData *NewRollPI )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewRollPI, offsetof(StabilizationBankData, RollPI), 3*sizeof(float));
}
コード例 #13
0
void StabilizationBankYawRatePIDArrayGet( float *NewYawRatePID )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewYawRatePID, offsetof(StabilizationBankData, YawRatePID), 4*sizeof(float));
}
コード例 #14
0
void StabilizationBankPitchRatePIDArraySet( float *NewPitchRatePID )
{
    UAVObjSetDataField(StabilizationBankHandle(), (void *)NewPitchRatePID, offsetof(StabilizationBankData, PitchRatePID), 4*sizeof(float));
}
コード例 #15
0
void StabilizationBankRollRatePIDGet( StabilizationBankRollRatePIDData *NewRollRatePID )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewRollRatePID, offsetof(StabilizationBankData, RollRatePID), 4*sizeof(float));
}
コード例 #16
0
void StabilizationBankThrustPIDScaleAxesGet(uint8_t *NewThrustPIDScaleAxes)
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewThrustPIDScaleAxes, offsetof(StabilizationBankData, ThrustPIDScaleAxes), sizeof(uint8_t));
}
コード例 #17
0
void StabilizationBankThrustPIDScaleCurveGet( float *NewThrustPIDScaleCurve )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewThrustPIDScaleCurve, offsetof(StabilizationBankData, ThrustPIDScaleCurve), 5*sizeof(float));
}
コード例 #18
0
void StabilizationBankManualRateGet( StabilizationBankManualRateData *NewManualRate )
{
    UAVObjGetDataField(StabilizationBankHandle(), (void *)NewManualRate, offsetof(StabilizationBankData, ManualRate), 3*sizeof(float));
}