fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-08 10:30:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

sensors: create vehicle_acceleration module (#12597)

Browse Source
This commit is contained in:
Daniel Agar
2019-08-07 05:05:48 -04:00
committed by GitHub
parent 50fbb56737
commit a917f22b65
25 changed files with 492 additions and 138 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/rover_pos_control/RoverPositionControl.cpp
+2 -4
View File
@@ -61,10 +61,8 @@ extern "C" __EXPORT int rover_pos_control_main(int argc, char *argv[]);
RoverPositionControl::RoverPositionControl() :
ModuleParams(nullptr),
/* performance counters */
_sub_sensors(ORB_ID(sensor_bias)),
_loop_perf(perf_alloc(PC_ELAPSED, "rover position control")) // TODO : do we even need these perf counters
{
}
RoverPositionControl::~RoverPositionControl()
@@ -197,7 +195,7 @@ RoverPositionControl::control_position(const matrix::Vector2f &current_position,
const Vector3f vel = R_to_body * Vector3f(ground_speed(0), ground_speed(1), ground_speed(2));
const float x_vel = vel(0);
const float x_acc = _sub_sensors.get().accel_x;
const float x_acc = _vehicle_acceleration_sub.get().xyz[0];
// Compute airspeed control out and just scale it as a constant
mission_throttle = _param_throttle_speed_scaler.get()
@@ -314,7 +312,7 @@ RoverPositionControl::run()
vehicle_control_mode_poll();
//manual_control_setpoint_poll();
_sub_sensors.update();
_vehicle_acceleration_sub.update();
/* update parameters from storage */
parameters_update(_params_sub);