Update CMD.c

Ajout des ligne 58 à 66 pour réduire le courant quand le moteur "ne tourne pas". Une erreure statique négligeable va être créer