Calibration params now saved to /.charging.yaml. Code rewritted towards human redability. Docking/undocking can be initiated by joystick button X. Controller speed-up. Added test mode for automated trials and a test script.