My version of the ik.ino.
Changed functions: directMove and moveToPoint