Implementation of MR

• constrained optimization

  • motion m(t )
  • set of constraints f(p)=0
  • objective function g(p)

• find a motion m(t ) satisfying f(m(t ))=0 and minimizing g(m(t ))

• numerical solving (sequential quadratic programming, least squares method)