diff --git a/deploy/robot_ws/src/go2py_node/src/bridge.cpp b/deploy/robot_ws/src/go2py_node/src/bridge.cpp index 8b81577..fd4aa12 100644 --- a/deploy/robot_ws/src/go2py_node/src/bridge.cpp +++ b/deploy/robot_ws/src/go2py_node/src/bridge.cpp @@ -177,12 +177,14 @@ void Custom::lowstate_callback(unitree_go::msg::LowState::SharedPtr data) } pub_joint->publish(joint_state); pub_imu->publish(imu); + // Check for emergency stop memcpy(&_keyData, &data->wireless_remote[0], 40); if (_keyData.btn.components.R2 == 1 && _keyData.btn.components.L2 == 1) { Estop = 1; } - if (_keyData.btn.components.R1 == 1 && _keyData.btn.components.L1 == 1) + if ((_keyData.btn.components.R1 == 1 && _keyData.btn.components.L1 == 1)|| + (_keyData.btn.components.L2 == 1 && _keyData.btn.components.A == 1)) { Estop = 0; }