Motion Planning And Control Of Compliant Autonomous Robots That Leverage Physical Interactions With The Environment