- [x] Add setpoint command - [x] Add teleop (manual control) commands - [x] Remove "safepoint" and "zero" positions - [x] Update constructor with new port numbers (currently using turret ports and CAN Bus IDs)