Optimization-Based Robot Programming with Application to Human-Robot Interaction door