Intégration de la fonction calculPWM

Fonction calculPWM à été intégré
Des corrections on été apporté pour
- la lecture de la trame
- la correction de la vitesse des moteurs