Usb disconnect

Resolves https://github.com/kliment/4pi-firmware/issues/25, and improves planner performance.