Fix Robot Interface header guards.
Add thread support for planar manipulator.
Add furthest distance support to robot interface.