Fixed path planning bug and added Arrow class.

The bug was caused due to incorrect indexing in tether segment
calculation.