worked on code implemented more commands, worked on servo controle