Separate servo controller and server port into different objects
User new servo port object
Add elbow
Cleanup
Add elbow
Rename servo_controller servo_port to better reflect what it is
Update elbow position