working on servo control
woring on freedrive mode