Hi!
Habe Deinen Code nicht geprüft.
Hast Du schnelle Dioden verwendet?
Prüfe mal, ob die SensEingänge wirklich auf GND liegen und löte sie am besten nochmal nach.
Dreht sich der Motor denn oder pfeift er wenigstens mit der PWM Frequenz?
Stell' doch die Frequenz mal auf zb 0,5 Hz runter und messe den Strom dann.
Gruß