Added code to set current motor position.