Adjust current sense for new gearbox, reduce latency, various bugfixes