|
@@ -265,7 +265,7 @@ void SaturnController::taskModeCallback(const std_msgs::msg::Bool::SharedPtr tas
|
|
|
}
|
|
|
|
|
|
void SaturnController::mainTimerCallback() {
|
|
|
- bool result = rcClientInterfaceGetCommonStatus(&common_status_data_);
|
|
|
+ common_status_result_ = rcClientInterfaceGetCommonStatus(&common_status_data_);
|
|
|
if(is_getting_com_success_ == true && result == false){
|
|
|
is_getting_com_success_ = false;
|
|
|
SPDLOG_INFO("rcClientInterfaceGetCommonStatus starts to fail.");
|
|
@@ -426,7 +426,9 @@ void SaturnController::publishBatteryState() { // todo
|
|
|
}
|
|
|
auto battery_state_state = sensor_msgs::msg::BatteryState();
|
|
|
battery_state_state.percentage = battery_power;
|
|
|
- battery_state_publisher_->publish(battery_state_state);
|
|
|
+ if(common_status_result_ == true){
|
|
|
+ battery_state_publisher_->publish(battery_state_state);
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
void SaturnController::publishChargingState() {
|