main function update

take x,y,z, and return steps and end effector orientation angle