It can almost find the arm's intended path. Works for first 5 points, trying to generalize to n points