|
@@ -186,14 +186,12 @@ void SaturnController::robotCommandCallback(
|
|
|
SPDLOG_INFO("stand or lie {}", common_status_data_.belie_or_stand);
|
|
|
if (common_status_data_.belie_or_stand ==
|
|
|
robot_control::common::BODY_POSTURE_STATE::STANDUP) {
|
|
|
- result = rcClientInterfaceSetScene(
|
|
|
- robot_control::common::CONTROL_SOURCE_MODE::nav_control,
|
|
|
- common::SCENE_TYPE::LIE_DOWN);
|
|
|
+ result = rcClientInterfaceLieDownOrStandUp(
|
|
|
+ robot_control::common::CONTROL_SOURCE_MODE::nav_control, 0);
|
|
|
} else if (common_status_data_.belie_or_stand ==
|
|
|
robot_control::common::BODY_POSTURE_STATE::LIEDOWN) {
|
|
|
- result = rcClientInterfaceSetScene(
|
|
|
- robot_control::common::CONTROL_SOURCE_MODE::nav_control,
|
|
|
- common::SCENE_TYPE::WALKING);
|
|
|
+ result = rcClientInterfaceLieDownOrStandUp(
|
|
|
+ robot_control::common::CONTROL_SOURCE_MODE::nav_control, 1);
|
|
|
}
|
|
|
} else if ("EnableNavigation" == request->comamnd_name) {
|
|
|
common::CONTROL_SOURCE_MODE nav_joy;
|