Motor control update

Now able to control motor
H-bridge

H-bridge development