Add option to disable sonar and small fixes
Implemented remote control and minor fixes