dispatchMotors() : refactoring and optimizing

[Neopibox]

We have to :

• change float to uint for "thrs" and pulse width ("times")
• Add map and constrains