Almost finished with robot class.
Almost finished with Robot class, linkages failing