1
0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-12-10 18:24:11 +01:00
LibrePilot/flight/modules/ManualControl/manualcontrol.c

621 lines
26 KiB
C
Raw Normal View History

/**
******************************************************************************
* @addtogroup OpenPilotModules OpenPilot Modules
* @{
* @addtogroup ManualControlModule Manual Control Module
* @brief Provide manual control or allow it alter flight mode.
* @{
*
* Reads in the ManualControlCommand FlightMode setting from receiver then either
* pass the settings straght to ActuatorDesired object (manual mode) or to
* AttitudeDesired object (stabilized mode)
*
* @file manualcontrol.c
2014-03-02 14:45:17 +01:00
* @author The OpenPilot Team, http://www.openpilot.org Copyright (C) 2014.
* @brief ManualControl module. Handles safety R/C link and flight mode.
*
* @see The GNU Public License (GPL) Version 3
*
*****************************************************************************/
/*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
* for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
2014-03-02 14:45:17 +01:00
#include "inc/manualcontrol.h"
#include <sanitycheck.h>
#include <manualcontrolsettings.h>
#include <manualcontrolcommand.h>
#include <accessorydesired.h>
#include <vtolselftuningstats.h>
2014-03-02 14:45:17 +01:00
#include <flightmodesettings.h>
#include <flightstatus.h>
#include <systemsettings.h>
#include <stabilizationdesired.h>
#include <callbackinfo.h>
#include <stabilizationsettings.h>
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
#include <vtolpathfollowersettings.h>
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
// Private constants
#if defined(PIOS_MANUAL_STACK_SIZE)
2015-01-09 21:49:03 +01:00
#define STACK_SIZE_BYTES PIOS_MANUAL_STACK_SIZE
#else
2015-01-09 21:49:03 +01:00
#define STACK_SIZE_BYTES 1152
#endif
2015-01-09 21:49:03 +01:00
#define CALLBACK_PRIORITY CALLBACK_PRIORITY_REGULAR
#define CBTASK_PRIORITY CALLBACK_TASK_FLIGHTCONTROL
2015-01-09 21:49:03 +01:00
#define ASSISTEDCONTROL_NEUTRALTHROTTLERANGE_FACTOR 0.2f
#define ASSISTEDCONTROL_BRAKETHRUST_DEADBAND_FACTOR_LO 0.96f
#define ASSISTEDCONTROL_BRAKETHRUST_DEADBAND_FACTOR_HI 1.04f
#define ALWAYSTABILIZEACCESSORY_THRESHOLD 0.05f
2014-03-02 14:45:17 +01:00
// defined handlers
static const controlHandler handler_MANUAL = {
2014-03-02 14:45:17 +01:00
.controlChain = {
.Stabilization = false,
.PathFollower = false,
.PathPlanner = false,
},
.handler = &manualHandler,
};
static const controlHandler handler_STABILIZED = {
2014-03-02 14:45:17 +01:00
.controlChain = {
.Stabilization = true,
.PathFollower = false,
.PathPlanner = false,
},
.handler = &stabilizedHandler,
};
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
static const controlHandler handler_PATHFOLLOWER = {
2014-03-02 14:45:17 +01:00
.controlChain = {
.Stabilization = true,
.PathFollower = true,
.PathPlanner = false,
},
.handler = &pathFollowerHandler,
};
static const controlHandler handler_PATHPLANNER = {
2014-03-02 14:45:17 +01:00
.controlChain = {
.Stabilization = true,
.PathFollower = true,
.PathPlanner = true,
},
.handler = &pathPlannerHandler,
};
static float thrustAtBrakeStart = 0.0f;
static float thrustLo = 0.0f;
static float thrustHi = 0.0f;
2014-04-30 22:20:07 +02:00
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
// Private variables
static DelayedCallbackInfo *callbackHandle;
2015-03-14 02:15:59 +01:00
static FrameType_t frameType = FRAME_TYPE_MULTIROTOR;
2014-03-02 14:45:17 +01:00
// Private functions
static void configurationUpdatedCb(UAVObjEvent *ev);
static void commandUpdatedCb(UAVObjEvent *ev);
static void manualControlTask(void);
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
static uint8_t isAssistedFlightMode(uint8_t position, uint8_t flightMode, FlightModeSettingsData *modeSettings);
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2015-03-10 13:07:14 +01:00
static void SettingsUpdatedCb(UAVObjEvent *ev);
2014-03-02 14:45:17 +01:00
#define assumptions (assumptions1 && assumptions2 && assumptions3 && assumptions4 && assumptions5 && assumptions6 && assumptions7 && assumptions_flightmode)
/**
* Module starting
*/
int32_t ManualControlStart()
{
2014-03-02 14:45:17 +01:00
// Run this initially to make sure the configuration is checked
configuration_check();
// Whenever the configuration changes, make sure it is safe to fly
SystemSettingsConnectCallback(configurationUpdatedCb);
ManualControlSettingsConnectCallback(configurationUpdatedCb);
ManualControlCommandConnectCallback(commandUpdatedCb);
// clear alarms
AlarmsClear(SYSTEMALARMS_ALARM_MANUALCONTROL);
2014-03-02 14:45:17 +01:00
SettingsUpdatedCb(NULL);
2014-03-02 14:45:17 +01:00
// Make sure unarmed on power up
armHandler(true, frameType);
2014-03-02 14:45:17 +01:00
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
takeOffLocationHandlerInit();
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
// Start main task
2014-03-02 14:45:17 +01:00
PIOS_CALLBACKSCHEDULER_Dispatch(callbackHandle);
return 0;
}
/**
* Module initialization
*/
int32_t ManualControlInitialize()
{
/* Check the assumptions about uavobject enum's are correct */
2014-03-02 14:45:17 +01:00
PIOS_STATIC_ASSERT(assumptions);
ManualControlCommandInitialize();
FlightStatusInitialize();
ManualControlSettingsInitialize();
FlightModeSettingsInitialize();
2014-03-02 14:45:17 +01:00
SystemSettingsInitialize();
StabilizationSettingsInitialize();
AccessoryDesiredInitialize();
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
VtolSelfTuningStatsInitialize();
VtolPathFollowerSettingsInitialize();
VtolPathFollowerSettingsConnectCallback(&SettingsUpdatedCb);
SystemSettingsConnectCallback(&SettingsUpdatedCb);
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
callbackHandle = PIOS_CALLBACKSCHEDULER_Create(&manualControlTask, CALLBACK_PRIORITY, CBTASK_PRIORITY, CALLBACKINFO_RUNNING_MANUALCONTROL, STACK_SIZE_BYTES);
return 0;
}
MODULE_INITCALL(ManualControlInitialize, ManualControlStart);
static void SettingsUpdatedCb(__attribute__((unused)) UAVObjEvent *ev)
{
2015-03-10 13:07:14 +01:00
frameType = GetCurrentFrameType();
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
VtolPathFollowerSettingsTreatCustomCraftAsOptions TreatCustomCraftAs;
VtolPathFollowerSettingsTreatCustomCraftAsGet(&TreatCustomCraftAs);
if (frameType == FRAME_TYPE_CUSTOM) {
switch (TreatCustomCraftAs) {
case VTOLPATHFOLLOWERSETTINGS_TREATCUSTOMCRAFTAS_FIXEDWING:
frameType = FRAME_TYPE_FIXED_WING;
break;
case VTOLPATHFOLLOWERSETTINGS_TREATCUSTOMCRAFTAS_VTOL:
frameType = FRAME_TYPE_MULTIROTOR;
break;
case VTOLPATHFOLLOWERSETTINGS_TREATCUSTOMCRAFTAS_GROUND:
frameType = FRAME_TYPE_GROUND;
break;
}
}
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
}
/**
* Module task
*/
2014-03-02 14:45:17 +01:00
static void manualControlTask(void)
{
2014-03-02 14:45:17 +01:00
// Process Arming
armHandler(false, frameType);
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
takeOffLocationHandler();
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
// Process flight mode
FlightStatusData flightStatus;
FlightStatusGet(&flightStatus);
2014-03-02 14:45:17 +01:00
ManualControlCommandData cmd;
ManualControlCommandGet(&cmd);
AccessoryDesiredData acc;
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
VtolPathFollowerSettingsThrustLimitsData thrustLimits;
VtolPathFollowerSettingsThrustLimitsGet(&thrustLimits);
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
FlightModeSettingsData modeSettings;
FlightModeSettingsGet(&modeSettings);
2014-03-02 14:45:17 +01:00
uint8_t position = cmd.FlightModeSwitchPosition;
uint8_t newMode = flightStatus.FlightMode;
uint8_t newAlwaysStabilized = flightStatus.AlwaysStabilizeWhenArmed;
uint8_t newFlightModeAssist = flightStatus.FlightModeAssist;
uint8_t newAssistedControlState = flightStatus.AssistedControlState;
uint8_t newAssistedThrottleState = flightStatus.AssistedThrottleState;
2014-03-02 14:45:17 +01:00
if (position < FLIGHTMODESETTINGS_FLIGHTMODEPOSITION_NUMELEM) {
newMode = modeSettings.FlightModePosition[position];
}
// if a mode change occurs we default the assist mode and states here
// to avoid having to add it to all of the below modes that are
// otherwise unrelated
if (newMode != flightStatus.FlightMode) {
// set assist mode to none to avoid an assisted flight mode position
// carrying over and impacting a newly selected non-assisted flight mode pos
newFlightModeAssist = FLIGHTSTATUS_FLIGHTMODEASSIST_NONE;
// The following are equivalent to none effectively. Code should always
// check the flightmodeassist state.
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
}
2014-03-02 14:45:17 +01:00
// Depending on the mode update the Stabilization or Actuator objects
const controlHandler *handler = &handler_MANUAL;
switch (newMode) {
case FLIGHTSTATUS_FLIGHTMODE_MANUAL:
2014-03-02 14:45:17 +01:00
handler = &handler_MANUAL;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED1:
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED2:
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED3:
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED4:
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED5:
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED6:
#if !defined(PIOS_EXCLUDE_ADVANCED_FEATURES)
case FLIGHTSTATUS_FLIGHTMODE_AUTOTUNE:
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
handler = &handler_STABILIZED;
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
newFlightModeAssist = isAssistedFlightMode(position, newMode, &modeSettings);
if (newFlightModeAssist != flightStatus.FlightModeAssist) {
// On change of assist mode reinitialise control state. This is required
// for the scenario where a flight position change reuses a flight mode
// but adds assistedcontrol.
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
}
if (newFlightModeAssist) {
// assess roll/pitch state
bool flagRollPitchHasInput = (fabsf(cmd.Roll) > 0.0f || fabsf(cmd.Pitch) > 0.0f);
// assess throttle state
bool throttleNeutral = false;
float neutralThrustOffset = 0.0f;
VtolSelfTuningStatsNeutralThrustOffsetGet(&neutralThrustOffset);
2015-01-09 21:49:03 +01:00
float throttleRangeDelta = (thrustLimits.Neutral + neutralThrustOffset) * ASSISTEDCONTROL_NEUTRALTHROTTLERANGE_FACTOR;
float throttleNeutralLow = (thrustLimits.Neutral + neutralThrustOffset) - throttleRangeDelta;
float throttleNeutralHi = (thrustLimits.Neutral + neutralThrustOffset) + throttleRangeDelta;
if (cmd.Thrust > throttleNeutralLow && cmd.Thrust < throttleNeutralHi) {
throttleNeutral = true;
}
// determine default thrust mode for hold/brake states
uint8_t pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
if (newFlightModeAssist == FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST) {
pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTO;
}
switch (newAssistedControlState) {
case FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY:
if (!flagRollPitchHasInput) {
// no stick input on roll/pitch so enter brake state
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_BRAKE;
newAssistedThrottleState = pathfollowerthrustmode;
handler = &handler_PATHFOLLOWER;
// retain thrust cmd for later comparison with actual in braking
thrustAtBrakeStart = cmd.Thrust;
// calculate hi and low value of +-4% as a mini-deadband
// for use in auto-override in brake sequence
thrustLo = ASSISTEDCONTROL_BRAKETHRUST_DEADBAND_FACTOR_LO * thrustAtBrakeStart;
thrustHi = ASSISTEDCONTROL_BRAKETHRUST_DEADBAND_FACTOR_HI * thrustAtBrakeStart;
// The purpose for auto throttle assist is to go from a mid to high thrust range to a
// neutral vertical-holding/maintaining ~50% thrust range. It is not designed/intended
// to go from near zero to 50%...we don't want an auto-takeoff feature here!
// Also for rapid decents a user might have a bit of forward stick and low throttle
// then stick-off for auto-braking...but if below the vtol min of 20% it will not
// kick in...the flyer needs to manually manage throttle to slow down decent,
// and the next time they put in a bit of stick, revert to primary, and then
// sticks-off it will brake and hold with auto-thrust
if (thrustAtBrakeStart < thrustLimits.Min) {
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
}
} else {
// stick input so stay in primary mode control state
// newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
}
break;
case FLIGHTSTATUS_ASSISTEDCONTROLSTATE_BRAKE:
if (flagRollPitchHasInput) {
// stick input during brake sequence allows immediate resumption of control
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
} else {
// no stick input, stay in brake mode
newAssistedThrottleState = pathfollowerthrustmode;
handler = &handler_PATHFOLLOWER;
// if auto thrust and user adjusts thrust outside of a deadband in which case revert to manual
if ((newAssistedThrottleState == FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTO) &&
(cmd.Thrust < thrustLo || cmd.Thrust > thrustHi)) {
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
}
}
break;
case FLIGHTSTATUS_ASSISTEDCONTROLSTATE_HOLD:
if (newFlightModeAssist == FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST_PRIMARYTHRUST ||
(newFlightModeAssist == FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST &&
newAssistedThrottleState == FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL)) {
// for manual or primary throttle states/modes, stick control immediately reverts to primary mode control
if (flagRollPitchHasInput) {
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
} else {
// otherwise stay in the hold state
// newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_HOLD;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
handler = &handler_PATHFOLLOWER;
}
} else if (newFlightModeAssist == FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST &&
newAssistedThrottleState != FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL) {
// ok auto thrust mode applies in hold unless overridden
if (flagRollPitchHasInput) {
// throttle is neutral approximately and stick input present so revert to primary mode control
newAssistedControlState = FLIGHTSTATUS_ASSISTEDCONTROLSTATE_PRIMARY;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
} else {
// otherwise hold, autothrust, no stick input...we watch throttle for need to change mode
switch (newAssistedThrottleState) {
case FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTO:
// whilst in auto, watch for neutral range, from which we allow override
if (throttleNeutral) {
pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTOOVERRIDE;
} else { pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTO; }
break;
case FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTOOVERRIDE:
// previously user has set throttle to neutral range, apply a deadband and revert to manual
// if moving out of deadband. This allows for landing in hold state.
if (!throttleNeutral) {
pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
} else { pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTOOVERRIDE; }
break;
case FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL:
pathfollowerthrustmode = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
break;
}
newAssistedThrottleState = pathfollowerthrustmode;
handler = &handler_PATHFOLLOWER;
}
}
break;
}
}
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
break;
#ifndef PIOS_EXCLUDE_ADVANCED_FEATURES
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
// During development the assistedcontrol implementation is optional and set
// set in stabi settings. Once if we decide to always have this on, it can
// can be directly set here...i.e. set the flight mode assist as required.
case FLIGHTSTATUS_FLIGHTMODE_VELOCITYROAM:
newFlightModeAssist = FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST_PRIMARYTHRUST;
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
handler = &handler_PATHFOLLOWER;
break;
case FLIGHTSTATUS_FLIGHTMODE_POSITIONHOLD:
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
case FLIGHTSTATUS_FLIGHTMODE_LAND:
case FLIGHTSTATUS_FLIGHTMODE_AUTOTAKEOFF:
newFlightModeAssist = isAssistedFlightMode(position, newMode, &modeSettings);
if (newFlightModeAssist) {
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
// Set the default thrust state
switch (newFlightModeAssist) {
case FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST_PRIMARYTHRUST:
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL;
break;
case FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST:
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_AUTO;
break;
case FLIGHTSTATUS_FLIGHTMODEASSIST_NONE:
default:
newAssistedThrottleState = FLIGHTSTATUS_ASSISTEDTHROTTLESTATE_MANUAL; // Effectively None
break;
}
}
handler = &handler_PATHFOLLOWER;
break;
case FLIGHTSTATUS_FLIGHTMODE_COURSELOCK:
2014-11-08 16:01:59 +01:00
case FLIGHTSTATUS_FLIGHTMODE_HOMELEASH:
case FLIGHTSTATUS_FLIGHTMODE_ABSOLUTEPOSITION:
2014-03-02 14:45:17 +01:00
case FLIGHTSTATUS_FLIGHTMODE_RETURNTOBASE:
case FLIGHTSTATUS_FLIGHTMODE_POI:
case FLIGHTSTATUS_FLIGHTMODE_AUTOCRUISE:
2014-03-02 14:45:17 +01:00
handler = &handler_PATHFOLLOWER;
break;
2014-03-02 14:45:17 +01:00
case FLIGHTSTATUS_FLIGHTMODE_PATHPLANNER:
handler = &handler_PATHPLANNER;
break;
#endif /* ifndef PIOS_EXCLUDE_ADVANCED_FEATURES */
2014-03-02 14:45:17 +01:00
// There is no default, so if a flightmode is forgotten the compiler can throw a warning!
}
bool alwaysStabilizedSwitch = false;
// Check for a AlwaysStabilizeWhenArmed accessory switch
switch (modeSettings.AlwaysStabilizeWhenArmedSwitch) {
case FLIGHTMODESETTINGS_ALWAYSSTABILIZEWHENARMEDSWITCH_ACCESSORY0:
AccessoryDesiredInstGet(0, &acc);
alwaysStabilizedSwitch = true;
break;
case FLIGHTMODESETTINGS_ALWAYSSTABILIZEWHENARMEDSWITCH_ACCESSORY1:
AccessoryDesiredInstGet(1, &acc);
alwaysStabilizedSwitch = true;
break;
case FLIGHTMODESETTINGS_ALWAYSSTABILIZEWHENARMEDSWITCH_ACCESSORY2:
AccessoryDesiredInstGet(2, &acc);
alwaysStabilizedSwitch = true;
break;
case FLIGHTMODESETTINGS_ALWAYSSTABILIZEWHENARMEDSWITCH_ACCESSORY3:
AccessoryDesiredInstGet(3, &acc);
alwaysStabilizedSwitch = true;
break;
default:
break;
}
if (alwaysStabilizedSwitch) {
if (acc.AccessoryVal <= -ALWAYSTABILIZEACCESSORY_THRESHOLD) {
newAlwaysStabilized = FLIGHTSTATUS_ALWAYSSTABILIZEWHENARMED_FALSE;
} else if (acc.AccessoryVal >= ALWAYSTABILIZEACCESSORY_THRESHOLD) {
newAlwaysStabilized = FLIGHTSTATUS_ALWAYSSTABILIZEWHENARMED_TRUE;
}
} else {
newAlwaysStabilized = FLIGHTSTATUS_ALWAYSSTABILIZEWHENARMED_FALSE;
}
bool newinit = false;
// FlightMode needs to be set correctly on first run (otherwise ControlChain is invalid)
static bool firstRun = true;
if (flightStatus.AlwaysStabilizeWhenArmed != newAlwaysStabilized ||
flightStatus.FlightMode != newMode || firstRun ||
newFlightModeAssist != flightStatus.FlightModeAssist ||
newAssistedControlState != flightStatus.AssistedControlState ||
flightStatus.AssistedThrottleState != newAssistedThrottleState) {
firstRun = false;
flightStatus.ControlChain = handler->controlChain;
flightStatus.FlightMode = newMode;
flightStatus.AlwaysStabilizeWhenArmed = newAlwaysStabilized;
flightStatus.FlightModeAssist = newFlightModeAssist;
flightStatus.AssistedControlState = newAssistedControlState;
flightStatus.AssistedThrottleState = newAssistedThrottleState;
FlightStatusSet(&flightStatus);
newinit = true;
}
if (handler->handler) {
2014-03-02 14:45:17 +01:00
handler->handler(newinit);
}
}
/**
2014-03-02 14:45:17 +01:00
* Called whenever a critical configuration component changes
*/
2014-03-02 14:45:17 +01:00
static void configurationUpdatedCb(__attribute__((unused)) UAVObjEvent *ev)
{
2014-03-02 14:45:17 +01:00
configuration_check();
}
/**
* Called whenever a critical configuration component changes
*/
2014-03-02 14:45:17 +01:00
static void commandUpdatedCb(__attribute__((unused)) UAVObjEvent *ev)
{
2014-03-02 14:45:17 +01:00
PIOS_CALLBACKSCHEDULER_Dispatch(callbackHandle);
}
#if !defined(PIOS_EXCLUDE_ADVANCED_FEATURES)
/**
* Check and set modes for gps assisted stablised flight modes
*/
static uint8_t isAssistedFlightMode(uint8_t position, uint8_t flightMode, FlightModeSettingsData *modeSettings)
{
//uint8_t isAssistedFlag = FLIGHTSTATUS_FLIGHTMODEASSIST_NONE;
StabilizationSettingsFlightModeAssistMapOptions FlightModeAssistMap[STABILIZATIONSETTINGS_FLIGHTMODEASSISTMAP_NUMELEM];
StabilizationSettingsFlightModeAssistMapGet(FlightModeAssistMap);
if (flightMode == FLIGHTSTATUS_FLIGHTMODE_AUTOTUNE
|| position >= STABILIZATIONSETTINGS_FLIGHTMODEASSISTMAP_NUMELEM) {
return (FLIGHTSTATUS_FLIGHTMODEASSIST_NONE);
}
switch (FlightModeAssistMap[position]) {
case STABILIZATIONSETTINGS_FLIGHTMODEASSISTMAP_NONE:
break;
case STABILIZATIONSETTINGS_FLIGHTMODEASSISTMAP_GPSASSIST:
{
// default to cruise control.
FlightModeSettingsStabilization1SettingsOptions thrustMode = FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_CRUISECONTROL;
switch (flightMode) {
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED1:
thrustMode = modeSettings->Stabilization1Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED2:
thrustMode = modeSettings->Stabilization2Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED3:
thrustMode = modeSettings->Stabilization3Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED4:
thrustMode = modeSettings->Stabilization4Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED5:
thrustMode = modeSettings->Stabilization5Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_STABILIZED6:
thrustMode = modeSettings->Stabilization6Settings.Thrust;
break;
case FLIGHTSTATUS_FLIGHTMODE_POSITIONHOLD:
case FLIGHTSTATUS_FLIGHTMODE_VELOCITYROAM:
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
// we hard code the "GPS Assisted" PostionHold/Roam to use alt-vario which
// is a more appropriate throttle mode. "GPSAssist" adds braking
// and a better throttle management to the standard Position Hold.
thrustMode = FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_ALTITUDEVARIO;
break;
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
case FLIGHTSTATUS_FLIGHTMODE_LAND:
case FLIGHTSTATUS_FLIGHTMODE_AUTOTAKEOFF:
OP-1696 PathFollower rewrite in C++ and Landing Squashed commit of the following: commit 580cd8addafadc3109b90b1fd183130ea8add7f2 Author: abeck70 <abeck70@icloud.com> Date: Fri Mar 20 21:32:33 2015 +1100 OP-1696 Cleanup and bug fix 1. Code review cleanup 2. Fixed gps assist braking - the thrust limits in piddown were not being set. commit 31ac4494f6e2bc5859f49d1f76f19fe3a4d32862 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 18 08:31:16 2015 +1100 OP-1696 fix initialisation of down pid control parameters commit a7bd737459249530bde9546b8247dd45b40dced4 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:18:38 2015 +1100 OP-1769 Actuator fix from code review commit 968172b8fb46c91b2611be4825e17faf2fa13411 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 21:01:11 2015 +1100 OP-1696 fixed ground pathfollower settings xml commit 721c07b67a87911ed67d0b62aa658cfac6d3eb97 Merge: f556215 be9f4ae Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:52:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit f556215ddbd5a29b22c2e6124372d74a0d6b9a0f Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 20:51:22 2015 +1100 OP-1696 ground pathfollower fixes commit 4584b22d6a2d33d3efb1cd11ac46804a5623a236 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 17 18:11:52 2015 +1100 OP-1696 Ground redesign 1. Move to new PID loop design 2. Prototype steering control commit b70c3373646fa758ae30a59765b8a56df7d2fbeb Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 18:42:06 2015 +1100 OP-1696 ground pathfollower added missing call to update velocity state commit a282bfb14dffcd486466b60be3100d26c11649ef Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 17:22:02 2015 +1100 OP-1696 ground pathfollower improvements commit f56ea4f9b101415e32e4464e51e087ee350be969 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 15 07:44:01 2015 +1100 OP-1696 remove unused PID controller in ground for vertical commit 6424aa0a84c3718a5a7b51fab1c9e04587d325b8 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:40:58 2015 +1100 OP-1696 Initialise vtolemergencyfallback variables commit 5d6110499bb06fe9b397e09dea5aafe994f03d13 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 21:30:21 2015 +1100 OP-1696 vtolflycontroller segv fixed and uncrustify commit bef23ea3dc2b5aff5b9b8713802586719b8f68cf Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:50:05 2015 +1100 OP-1783 PathPlanner Instead of config alarm if no pathplan, simply continue to alarm pathplan, but allow normal arming and flight in other modes. If pathplan enabled, simply enter position hold. commit 370f1747209cca7c01c071a43224ad83b04bdd55 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 20:48:22 2015 +1100 OP-1769 Ground code review comment 1. Remove idx1 < 0 check not needed 2. Should return abs_input in the corner case that curve is "invalid". commit 01973c656d783e035ad823c267d3387bf473eebe Merge: be07d12 5c9b6fa Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 14 12:17:31 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit be07d125f42b5ca1aabce0f5c0fcf592e8cddf98 Merge: 44afdc7 ad44b31 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 21:55:52 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 44afdc77987049dc58cdf42e3be88b7eae38de02 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 19:35:55 2015 +1100 OP-1696 fix startup Fix initialisation and void use of pios_malloc at startup commit 962f5f75756883cec6726c0347310d60264f6989 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:48:04 2015 +1100 OP-1696 undo changes to make file commit 7fa71d5c614d492cb4026312672068f92a4bcd3e Merge: 672732e 5a9cfa6 Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 12 18:06:59 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 672732e95d555946300ef5093f687f3fa88bfd3a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:59:44 2015 +1100 OP-1696 code review comments commit 73b295d6515f2489b3b3a61459c975b0c37afe3d Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 11 12:47:24 2015 +1100 OP-1696 code review comments commit 524b72f537fe922bf3c4385b418872f13819a5cf Merge: 6beef01 ba5f395 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 10 23:19:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 6beef01476d06598652a10de4857e6ae55015417 Merge: 100cf33 8c31f96 Author: abeck70 <abeck70@icloud.com> Date: Sat Mar 7 16:50:32 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 100cf335d187fe696d3678371b194fc3044a1c7e Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 22:32:30 2015 +1100 OP-1696 simposix c++ compilation fix commit 9ebf846d1ec8fef30ffc1204546fc5dc648ec10b Author: Alex Beck <abeck70@icloud.com> Date: Thu Mar 5 21:35:39 2015 +1100 OP-1696 fix simposix c++ compile of pathfollower commit a86b4b1db46dba569739587ee57b03460381ebab Author: abeck70 <abeck70@icloud.com> Date: Thu Mar 5 18:03:51 2015 +1100 OP-1696 resolve linux build issue commit 1d7695f81293534bc17f69b0fcd9de3876867f6a Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 18:10:09 2015 +1100 OP-1696 Return to Base & Land implemented Enabled via FlightModeSettings ReturnToBaseNextCommand = LAND commit 4e5ca807b18a40ea60c05c1b46f738462595a6b2 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 16:38:06 2015 +1100 OP-1696 reduce memory footprint by only allocating controllers required for a particular frame type commit 78e8f559cd25ffaeac68b563e25d1ad357205fd6 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:51:05 2015 +1100 OP-1696 move fsm initialisation to controller implementations commit 848c78a84e5c7e11b2da953c9d9549b11fc5b1d8 Author: abeck70 <abeck70@icloud.com> Date: Wed Mar 4 13:27:11 2015 +1100 OP-1696 reduce memory through re-use of pointers to data objects in base class. commit bc8794601142055942910ba9f938c03c8a3ca547 Merge: 24bc3de 843325d Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 22:06:01 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 24bc3de6155a74850b17ca7706f6b592923e027c Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 17:56:12 2015 +1100 OP-1696 update gcs path planner options to align to new modes commit dc659891882ea0624a6436550425c54b347f4101 Author: abeck70 <abeck70@icloud.com> Date: Tue Mar 3 13:51:55 2015 +1100 OP-1696 pathfollower class renaming and uncrustify commit af19d114b8e0ff23159bdaca37e5f5bf1c1f8beb Merge: b07c1fd 04f4cd9 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:47:12 2015 +1100 Merge branch 'rel-15.02' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b07c1fdd0544a555678bc7a8510cd92861f17e46 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 21:27:27 2015 +1100 OP-1696 remainder of changes to integrate drive and fly objectives commit c824c53cf30889a468ecb25ae3d705fa011b23ba Merge: b89751c 1102243 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:06:13 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit b89751caa5d6dc06e1e20391aa4e12b5484056d4 Author: abeck70 <abeck70@icloud.com> Date: Mon Mar 2 17:04:27 2015 +1100 OP-1696 merge fly and drive pathdesired/action objectives commit c463132cb7da5cdf9fc5395ae0650b081bc9fb55 Author: abeck70 <abeck70@icloud.com> Date: Sun Mar 1 10:25:29 2015 +1100 OP-1696 merge ground pathfollower and refactored into C++ commit 6ed504b32f9e502e4f02d50b9e85ba91591417ba Merge: bcf245e deafed6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:12:32 2015 +1100 Merge branch 'next' into corvuscorax/OP-1642_tank-support Conflicts: flight/modules/PathFollower/pathfollower.c shared/uavobjectdefinition/vtolpathfollowersettings.xml commit bcf245e08c3348f2e6e5eddceee6d6cc268bdc23 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 19:45:29 2014 +0100 OP-1642 added new uavobject to discovery target, too commit 6b9e8a7d7dad0739b4ffd2ce7f2f78ed4f597077 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:58:18 2014 +0100 OP-1642 added very simple path control for ground vehicles commit e8d8440e049c06158e7fc542627fac6420abaf65 Author: Corvus Corax <corvuscorax@cybertrench.com> Date: Sat Dec 6 17:17:09 2014 +0100 OP-1642 added new settings uavobject for tank path follower commit 71dd726eb5b52614b417236c22e8a5cc3a487faf Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 27 18:05:10 2015 +1100 OP-1696 align pathaction to pathdesired commit 8a88af83be457aafbb63e4f94fad3b1cd54264ca Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 26 08:06:34 2015 +1100 OP-1696 fixed wing control refactored and compiling commit fd9850b5e5680f5b422dbc468a94c5ec4b6dd518 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 17:47:19 2015 +1100 OP-1696 Removed vtol stuff from pathfollower.cpp after having replaced it with class impl commit 9127d8d6d8c345c5bbf8622ce4e5eb76b03d1356 Merge: 4054c73 93fb2d5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 25 13:09:06 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 4054c73ac98b54188a0a5367c5ca913b7fee6a89 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:29:28 2015 +1100 OP-1696 fix compile errors commit b398db3d4de8cd621a059da1f0dbb00868be0fb9 Merge: 94c795a 3e15cac Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 24 12:06:35 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 94c795af386cf0f1072a88e99a80cb1080bf85e7 Merge: d2115de 57e0a8b Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 17:54:33 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 Conflicts: flight/modules/Sensors/sensors.c make/common-defs.mk commit d2115dee4e8e9b6a02f7b7700e4715480a56b18f Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 23 14:35:02 2015 +1100 OP-1696 preliminary checkin for refactor of fly TODO: 1. Finalise and test fly, brake 2. Remove patfhollower vtol fly 3. Rename all objects adding vtol in name commit 95804b1d591d194cce3596187c74cdb2dd0d192f Merge: 58cebb0 31c1385 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:10:03 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 58cebb0658deaece1555cfa24e50f1b86fd68c96 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 21 22:09:29 2015 +1100 OP-1696 refactor neutral thrust and add pos hold implementation commit 2c3cadfef3de9e092bd66bbabc58ac7847aca7e4 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 20 18:32:11 2015 +1100 OP-1696 start of refactor of braking commit 991c2124e834f3432f5e34c5c9f4966cb42a7be3 Merge: 1ab5798 db7d605 Author: abeck70 <abeck70@icloud.com> Date: Thu Feb 19 12:17:54 2015 +1100 Merge branch 'next' of ssh://git.openpilot.org/OpenPilot into abeck/OP-1696 commit 1ab579865f04aeaa5899f5065a983de29074e025 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 21:29:01 2015 +1100 OP-1696 Rewrote velocity roam into new C++ OO architecture With use of new PID controller for NE. commit 03edb049f06bf60054dce36a5b8b301a397284c4 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 18 12:19:17 2015 +1100 OP-1696 Start of refactoring of VelocityRoam implementation in PathFollower Also TODOs: 1. To support pathplanner, remove all references to FlightStatus object and add more fields to PathDesired 2. Refactor Braking to use C++ 3. Test and optimise Velocity Roam 4. Add more config options to Landing. For example disable disarming. And add more setting objects. 5. Consider moving all landing settings to one object. commit 1f5dba821d4535a9a14f333efdeec1af5afcc281 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 22:51:31 2015 +1100 OP-1696 Landing tuning commit 5133956c717fba871dd5700333806e298038a3d0 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 16 21:05:06 2015 +1100 OP-1696 Landing Multiple fixes commit cf22055ecb8eb7304174c730f249a2332ebc599b Author: abeck70 <abeck70@icloud.com> Date: Sun Feb 15 20:52:29 2015 +1100 OP-1696 Add PIDStatus debug object commit bc13d732601e7c7cb48db17f1a75b33cc96c0c34 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 15:53:16 2015 +1100 OP-1696 Landing sanity tested commit 6e913076c1dfcb8b90153e9eca8acf6c9e51f293 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 14 11:16:06 2015 +1100 OP-1696 completed refactoring 1. Completed refactoring of NE and Thrust control 2. Fixed velocity roam TODO Tuning and testing commit 63b62fbd0ac105029e54163b98c3beebc2d73c3a Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 13 08:54:23 2015 +1100 OP-1696 New PID Controller and refactoring of PID implementation for thrust management commit 7474331529477d0badd2ef0d609c84c556be9cec Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 10 16:39:44 2015 +1100 OP-1696 Landing Refactor Thrust PID Loop for landing commit 904ab2a9241e40c19da6a1508b4ce5243c75d7a3 Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:13:39 2015 +1100 OP-1696 Uncrustify commit b3d30e298d8a0343782a29bc91be6677105b325e Author: abeck70 <abeck70@icloud.com> Date: Mon Feb 9 22:05:05 2015 +1100 OP-1696 Create new OO design Added PathFollowerControl which has an Landing implementation. The landing implementation runs its own set of PIDs. And interfaces to the FSM for Landing. commit 1ffd8d67cf7310c1c18c90f3ba18b08221d185a3 Author: abeck70 <abeck70@icloud.com> Date: Sat Feb 7 18:04:42 2015 +1100 OP-1696 Upgrade arm tools commit 3df01f97021d13694027b92ba0b13cc9fe70d437 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 21:52:38 2015 +1100 OP-1696 Landing uncrustify and start of refactoring landing to make more use of FSMLand commit 7a753b65fb69d52c89875b9a182ef5210ee8ef2d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 15:08:29 2015 +1100 OP-1696 Landing: fix compilation of all exes commit 692459874acf2b7ae07aa3ab88a2c78a09f26ee6 Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 14:45:06 2015 +1100 OP-1696 Landing startup fixes commit 9851f29b9238a969efd0110f01a4fad6bdbc5a5d Author: abeck70 <abeck70@icloud.com> Date: Fri Feb 6 10:21:52 2015 +1100 OP-1696 Landing pathfollower CPP refactoring commit 9b3a54d41f14f07cd0d78426026d12ae9ac4e5b5 Author: abeck70 <abeck70@icloud.com> Date: Wed Feb 4 13:02:44 2015 +1100 OP-1696 Moved to FSMLand class and fixed CPP problems 1. Additional methods, compile options, and need to have main as a cpp to solve various link issues when using static constructors but to avoid adding unnecessary libs. commit 7ebe739bfdb4e0f598f4408c1488f01bc033c044 Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:17:08 2015 +1100 OP-1696 Initial Landing prototype Proof of concept. To be refactored into C++ commit 11d6754b9766efb76cc1cd57e9894badaf33ef2d Author: abeck70 <abeck70@icloud.com> Date: Tue Feb 3 22:13:10 2015 +1100 OP-1696 CPP Enablement revo c++ Enable optional revo C++ support: 1. Set USE_CXX to enable compliation and linkage of C++ source code 2. Disables rtti and exceptions 3. operator new and delete call pios malloc/free 4. Static constructor invocation supported
2015-03-20 11:42:20 +01:00
thrustMode = FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_CRUISECONTROL;
break;
// other modes will use cruisecontrol as default
}
switch (thrustMode) {
case FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_ALTITUDEHOLD:
case FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_ALTITUDEVARIO:
// this is only for use with stabi mods with althold/vario.
//isAssistedFlag = FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST_PRIMARYTHRUST;
//break;
return FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST_PRIMARYTHRUST;
case FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_MANUAL:
case FLIGHTMODESETTINGS_STABILIZATION1SETTINGS_CRUISECONTROL:
default:
// this is the default for non stabi modes also
//isAssistedFlag = FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST;
//break;
return FLIGHTSTATUS_FLIGHTMODEASSIST_GPSASSIST;
}
}
break;
}
//return isAssistedFlag;
return FLIGHTSTATUS_FLIGHTMODEASSIST_NONE;
}
#endif /* !defined(PIOS_EXCLUDE_ADVANCED_FEATURES) */
/**
* @}
* @}
*/