changed driving code, started servos
bug fixes and servo camera movement