Optimal Energy Consumption for Mobile Manipulators Executing Door-Opening Task

Algorithm 1

Select the optimal motion of door.

Input: the spline functions for all time internals

Output: the torques and the parameters of Eq. (21)

For in range

  Based on Quasi-Newton method

  with constraint

   Obtain

   solve

End

Return ,