Adds ultrasonic mode
* fix motor library
Adds bluetooth mode