diff --git a/include/can/core/message_handlers/motion.hpp b/include/can/core/message_handlers/motion.hpp index d4d367999..d8575df3c 100644 --- a/include/can/core/message_handlers/motion.hpp +++ b/include/can/core/message_handlers/motion.hpp @@ -48,7 +48,8 @@ class BrushedMotionHandler { using MessageType = std::variant; + SetGripperErrorToleranceRequest, GetMotorUsageRequest, + GripperJawStateRequest>; BrushedMotionHandler(BrushedMotionTaskClient &motion_client) : motion_client{motion_client} {} diff --git a/include/gripper/core/can_task.hpp b/include/gripper/core/can_task.hpp index f76f0c960..0b560acfe 100644 --- a/include/gripper/core/can_task.hpp +++ b/include/gripper/core/can_task.hpp @@ -48,7 +48,7 @@ using BrushedMotionDispatchTarget = can::dispatch::DispatchParseTarget< can::messages::DisableMotorRequest, can::messages::EnableMotorRequest, can::messages::ReadLimitSwitchRequest, can::messages::MotorPositionRequest, can::messages::SetGripperErrorToleranceRequest, - can::messages::GetMotorUsageRequest>; + can::messages::GetMotorUsageRequest, can::messages::GripperJawStateRequest>; using BrushedMoveGroupDispatchTarget = can::dispatch::DispatchParseTarget< can::message_handlers::move_group::BrushedMoveGroupHandler< g_tasks::QueueClient>, diff --git a/include/motor-control/core/brushed_motor/brushed_motion_controller.hpp b/include/motor-control/core/brushed_motor/brushed_motion_controller.hpp index d099adb0f..a7a40cacd 100644 --- a/include/motor-control/core/brushed_motor/brushed_motion_controller.hpp +++ b/include/motor-control/core/brushed_motor/brushed_motion_controller.hpp @@ -105,10 +105,9 @@ class MotionController { queue.reset(); // if we're gripping something we need to flag this so we don't drop it if (!hardware.get_stay_enabled()) { - disable_motor(); - } - if (hardware.is_timer_interrupt_running()) { - hardware.request_cancel(); + if (hardware.is_timer_interrupt_running()) { + hardware.request_cancel(); + } } }