Test code for the H-bridge

This is only a test code for the motor control unit (H-bridge)