change name
add TODO functions of position control