Contact Mechanics-based Gait Generation and Trajectory Tracking Algorithm for Radial-skeleton Robots