Rover: move rally to g2

This commit is contained in:
Randy Mackay 2018-08-30 09:54:12 +09:00
parent 90fd64cf3a
commit f0ad8760e2
5 changed files with 14 additions and 13 deletions

View File

@ -1308,7 +1308,7 @@ AP_Mission *GCS_MAVLINK_Rover::get_mission()
AP_Rally *GCS_MAVLINK_Rover::get_rally() const AP_Rally *GCS_MAVLINK_Rover::get_rally() const
{ {
#if AC_RALLY == ENABLED #if AC_RALLY == ENABLED
return &rover.rally; return &rover.g2.rally;
#else #else
return nullptr; return nullptr;
#endif #endif

View File

@ -356,12 +356,6 @@ const AP_Param::Info Rover::var_info[] = {
GOBJECT(camera_mount, "MNT", AP_Mount), GOBJECT(camera_mount, "MNT", AP_Mount),
#endif #endif
#if AC_RALLY == ENABLED
// @Group: RALLY_
// @Path: AP_Rally.cpp,../libraries/AP_Rally/AP_Rally.cpp
GOBJECT(rally, "RALLY_", AP_Rally_Rover),
#endif
// @Group: ARMING_ // @Group: ARMING_
// @Path: ../libraries/AP_Arming/AP_Arming.cpp // @Path: ../libraries/AP_Arming/AP_Arming.cpp
GOBJECT(arming, "ARMING_", AP_Arming), GOBJECT(arming, "ARMING_", AP_Arming),
@ -591,6 +585,12 @@ const AP_Param::GroupInfo ParametersG2::var_info[] = {
// @Path: ../libraries/AP_WheelEncoder/AP_WheelRateControl.cpp // @Path: ../libraries/AP_WheelEncoder/AP_WheelRateControl.cpp
AP_SUBGROUPINFO(wheel_rate_control, "WRC", 27, ParametersG2, AP_WheelRateControl), AP_SUBGROUPINFO(wheel_rate_control, "WRC", 27, ParametersG2, AP_WheelRateControl),
#if AC_RALLY == ENABLED
// @Group: RALLY_
// @Path: AP_Rally.cpp,../libraries/AP_Rally/AP_Rally.cpp
AP_SUBGROUPINFO(rally, "RALLY_", 28, ParametersG2, AP_Rally_Rover),
#endif
AP_GROUPEND AP_GROUPEND
}; };
@ -621,7 +621,8 @@ ParametersG2::ParametersG2(void)
fence(rover.ahrs), fence(rover.ahrs),
proximity(rover.serial_manager), proximity(rover.serial_manager),
avoid(rover.ahrs, fence, rover.g2.proximity, &rover.g2.beacon), avoid(rover.ahrs, fence, rover.g2.proximity, &rover.g2.beacon),
follow() follow(),
rally(rover.ahrs)
{ {
AP_Param::setup_object_defaults(this, var_info); AP_Param::setup_object_defaults(this, var_info);
} }

View File

@ -4,6 +4,7 @@
#include "RC_Channel.h" #include "RC_Channel.h"
#include "AC_Sprayer/AC_Sprayer.h" #include "AC_Sprayer/AC_Sprayer.h"
#include "AP_Rally.h"
// Global parameter class. // Global parameter class.
// //
@ -54,7 +55,6 @@ public:
k_param_serial0_baud, // deprecated, can be deleted k_param_serial0_baud, // deprecated, can be deleted
k_param_serial1_baud, // deprecated, can be deleted k_param_serial1_baud, // deprecated, can be deleted
k_param_serial2_baud, // deprecated, can be deleted k_param_serial2_baud, // deprecated, can be deleted
k_param_rally,
// 97: RSSI // 97: RSSI
k_param_rssi = 97, k_param_rssi = 97,
@ -364,6 +364,9 @@ public:
// Sprayer // Sprayer
AC_Sprayer sprayer; AC_Sprayer sprayer;
// Rally point library
AP_Rally_Rover rally;
}; };
extern const AP_Param::Info var_info[]; extern const AP_Param::Info var_info[];

View File

@ -242,9 +242,6 @@ private:
AP_Mount camera_mount{ahrs, current_loc}; AP_Mount camera_mount{ahrs, current_loc};
#endif #endif
// Rally library
AP_Rally_Rover rally{ahrs};
// true if initialisation has completed // true if initialisation has completed
bool initialised; bool initialised;

View File

@ -10,7 +10,7 @@ bool ModeRTL::_enter()
// initialise waypoint speed // initialise waypoint speed
set_desired_speed_to_default(true); set_desired_speed_to_default(true);
return_target = rover.rally.calc_best_rally_or_home_location(rover.current_loc, ahrs.get_home().alt); return_target = rover.g2.rally.calc_best_rally_or_home_location(rover.current_loc, ahrs.get_home().alt);
// set destination // set destination
set_desired_location(return_target); set_desired_location(return_target);
return true; return true;