diff --git a/src/modules/simulator/simulator.h b/src/modules/simulator/simulator.h index 18b7248117bd192f3774216a212d681e07fddee2..ec7551ac9ed96f7080e098f37ed23df894c238d9 100644 --- a/src/modules/simulator/simulator.h +++ b/src/modules/simulator/simulator.h @@ -383,10 +383,10 @@ private: vehicle_status_s _vehicle_status {}; DEFINE_PARAMETERS( - (ParamFloat<px4::params::SIM_BAT_DRAIN>) _battery_drain_interval_s, ///< battery drain interval - (ParamInt<px4::params::MAV_TYPE>) _param_system_type, - (ParamInt<px4::params::MAV_SYS_ID>) _param_system_id, - (ParamInt<px4::params::MAV_COMP_ID>) _param_component_id + (ParamFloat<px4::params::SIM_BAT_DRAIN>) _param_sim_bat_drain, ///< battery drain interval + (ParamInt<px4::params::MAV_TYPE>) _param_mav_type, + (ParamInt<px4::params::MAV_SYS_ID>) _param_mav_sys_id, + (ParamInt<px4::params::MAV_COMP_ID>) _param_mav_comp_id ) #endif diff --git a/src/modules/simulator/simulator_mavlink.cpp b/src/modules/simulator/simulator_mavlink.cpp index d78882dc2c130654008e59957b5419b2d62ef7c1..293ded4e3456e0c9f967d4a06a17077e8b46bb4b 100644 --- a/src/modules/simulator/simulator_mavlink.cpp +++ b/src/modules/simulator/simulator_mavlink.cpp @@ -85,7 +85,7 @@ mavlink_hil_actuator_controls_t Simulator::actuator_controls_from_outputs(const const float pwm_center = (PWM_DEFAULT_MAX + PWM_DEFAULT_MIN) / 2; - int _system_type = _param_system_type.get(); + int _system_type = _param_mav_type.get(); /* scale outputs depending on system type */ if (_system_type == MAV_TYPE_QUADROTOR || @@ -184,7 +184,7 @@ void Simulator::send_controls() const mavlink_hil_actuator_controls_t hil_act_control = actuator_controls_from_outputs(actuators); mavlink_message_t message{}; - mavlink_msg_hil_actuator_controls_encode(_param_system_id.get(), _param_component_id.get(), &message, &hil_act_control); + mavlink_msg_hil_actuator_controls_encode(_param_mav_sys_id.get(), _param_mav_comp_id.get(), &message, &hil_act_control); PX4_DEBUG("sending controls t=%ld (%ld)", actuators.timestamp, hil_act_control.time_usec); @@ -385,7 +385,7 @@ void Simulator::handle_message_hil_sensor(const mavlink_message_t *msg) // battery simulation (limit update to 100Hz) if (hrt_elapsed_time(&_battery_status.timestamp) >= 10_ms) { - const float discharge_interval_us = _battery_drain_interval_s.get() * 1000 * 1000; + const float discharge_interval_us = _param_sim_bat_drain.get() * 1000 * 1000; bool armed = (_vehicle_status.arming_state == vehicle_status_s::ARMING_STATE_ARMED); @@ -642,7 +642,7 @@ void Simulator::request_hil_state_quaternion() cmd_long.command = MAV_CMD_SET_MESSAGE_INTERVAL; cmd_long.param1 = MAVLINK_MSG_ID_HIL_STATE_QUATERNION; cmd_long.param2 = 5e3; - mavlink_msg_command_long_encode(_param_system_id.get(), _param_component_id.get(), &message, &cmd_long); + mavlink_msg_command_long_encode(_param_mav_sys_id.get(), _param_mav_comp_id.get(), &message, &cmd_long); send_mavlink_message(message); } @@ -652,7 +652,7 @@ void Simulator::send_heartbeat() mavlink_message_t message = {}; hb.autopilot = 12; hb.base_mode |= (_vehicle_status.arming_state == vehicle_status_s::ARMING_STATE_ARMED) ? 128 : 0; - mavlink_msg_heartbeat_encode(_param_system_id.get(), _param_component_id.get(), &message, &hb); + mavlink_msg_heartbeat_encode(_param_mav_sys_id.get(), _param_mav_comp_id.get(), &message, &hb); send_mavlink_message(message); }