Get motor position. Not completed yet
Signed-off-by: H.K. Wong <hkwong74531@yahoo.com.hk>