added position controll function
added sin follower that uses position control function