Add SDO object & SDO update for sensor polarity. Update drive
functions for position control with ticks.
test csp based on encoder ticks