[Systems] Motor Controller Features

[ttchalakov]

Features to Add to Motor Controller Package

• [ ] Clean up arduino, jetson, driver station communication.
• [ ] Update the jetson and teleop package to have updated button and joystick assignments.
• [ ] Add encoders to arduino code and send angles back to ros network (https://reference.arduino.cc/reference/en/libraries/rotaryencoder/).
• [ ] Add PID control with set point values sent from the ROS network (https://github.com/br3ttb/Arduino-PID-Library).