ANALYSIS ON FORCE AND ENERGY CONSUMPTION BASED ON PD COMBINED WITH INPUT-SHAPING CONTROL FOR ELASTIC MECHANISMS WITH A RIGID MODE