Addition of right hand trajectory task completed. All equations and desired trajectories included