Robot Motion Planning in Optimization Frameworks