added sensor feedback into motor interrupts

added sensor feedback into motor interrupts