Fixes for competition

Kill should work
Acc offsets implemented
Calibration command implemented
Default mode can be set
Motor test is 2s on, 1s off
Depth conversion fixed
Default timeout is 10s
Full depth conversion

No offset on Z