Worked on servo stuff to get a better interface were you can specify the position of the servo and how long it should take to move there