Non-linear Control for Underactuated Mechanical Systems door