Tethered Motion Planning for a Rappelling Robot