Added second motor
adding ultra sonic sensor and a few basic functions for movement