- [x] create hal repo - [x] include kinova lib and setup cmake - [x] setup robot workspace in the lab - [x] connect to the robot and do high level motion - [x] read joints - [x] switch to (zero) torque control - [x] improve control mode switch (don't go back to previous position) - [x] apply torques (so that external forces do not trigger a switch to position control) - [x] synchronize with dls messages - [x] get robot state and write to arm_state (out) - [x] read desired torques and apply to robot (in)