Thrusters moving without command

@estelome, this code is complex, and the problem you are seeing is probably a bug in your code. Try to use our example sketch to determine if there is a problem with the thruster or esc.