1P1-E6 Gain Scheduling PD Sway Control of a Trolly Overhead Crane and Implementation for a Rescue Robot