Skip to content

Commit

Permalink
Improve format
Browse files Browse the repository at this point in the history
  • Loading branch information
DrDab committed Nov 7, 2023
1 parent 12ad0de commit 0777df1
Showing 1 changed file with 2 additions and 0 deletions.
2 changes: 2 additions & 0 deletions src/network/MissionControlProtocol.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -138,10 +138,12 @@ void MissionControlProtocol::handleSetArmIKEnabled(const json& j) {
}
DataPoint<navtypes::Vectord<Constants::arm::IK_MOTORS.size()>> armJointPositions =
robot::getMotorPositionsRad(Constants::arm::IK_MOTORS);

// TODO: there should be a better way of handling invalid data than crashing.
// It should somehow just not enable IK, but then it needs to communicate back to MC
// that IK wasn't enabled?
assert(armJointPositions.isValid());

if (Globals::planarArmController.set_setpoint(armJointPositions.getData())) {
Globals::armIKEnabled = true;
_arm_ik_repeat_thread =
Expand Down

0 comments on commit 0777df1

Please sign in to comment.