Optimal Energy Consumption for Mobile Manipulators Executing Door-Opening Task

Algorithm 2

Search the optimal position of robot base.

Input:

Output: the minimum and the corresponding base position

For in range

   If

   then ,  ,  ,

End

Return