start expand control to henqu motors

1.succeed controling speed using duty cycle
2.to be done: to verify dir control
3.to be done: to realise speed sense