Locomotion generation for a mobile manipulator by global minimization of the weighted generalized momentum

This article presents a method for generating the locomotion of a mobile manipulator that globally minimizes the weighted generalized momentum. The method utilizes the calculus of variation setting to address the problem for which the optimal trajectory may be computed by solving the initial value problem of the system of ordinary differential equations rather than the two-point boundary value problem. Online optimal trajectory may then be input to a suitable tracking controller for controlling the robot in real time. Effectively, the robot closed-loop dynamics is shaped to the optimal system such that the locomotion minimizes the difference of the weighted generalized momentum and the assigned potential energy under the constraints imposed on by the tracking task, joint angle, and actuator torque limits. Desired locomotion behaviors may be achieved by properly adjusting the weighting, spring, and damping matrices. Exploiting the induced dynamical force from the cooperative motion of the constituent linkages through the momentum minimization basis, the robot is able to outperform conventional locomotion pattern actuated by the platform solely.


Introduction
A mobile manipulator, hereafter called a robot for short, generally consists of the mobile platform and the mounted manipulator. 1,2 Together, the number of degrees of freedom (DOFs) the robot owned is usually more than required to execute the tasks, that is, the robot is redundant. Hence, it is capable of performing manipulation tasks with high dexterity at different places. Redundancy may also be useful to locomotion, which is the topic of this article. Typically, the mobile base is locomoted to the desired place and then the manipulator can perform tasks at that location. It is observed that during the relocation, the manipulator does not perform any specific task and commonly will be kept at rest relative to the base.
This motion strategy is simple since it put away with the motion planning on those redundant coordinates. Control is also simplified to the regulation control problem. However, it is evident that the animal limbs move during locomotion. While walking or running, human arm naturally swings in opposite direction to the leg motion even though it can be kept fixed deliberately. Studies showed that such arm motion reduces the metabolic energy consumed. 3,4 Such motion can be observed in advanced robot counterparts. For example, the mobile robot "Handle" 5 or the humanoid robot "Atlas" 6 is capable of performing energetically impressive locomotion using the whole body motion. This would not be possible using the leg movement solely.
When someone on a boat fires a gun, the boat moves in the opposite direction to the bullet. This phenomenon is explainable by the conservation of momentum, that is, momentum of the bullet is canceled by that of the boat. Hence, motion of the boat is induced by that of the bullet. Such induced motion can be seen in human and robot locomotion caused by complex interplay of the coupled forces. It may be understood as the system strives to conserve the momentum in a manner that movement of all linkages helps driving the body as a whole. Note that when the system is initially at rest, its momentum is zero. Hence, attempting to conserve the momentum implies minimizing its magnitude subject to the motion constraint. With this strategy, the energy spent in the locomotion can be minimized. Moreover, torques that execute the motion will come from all joints rather than their subset at the platform. This inspires us to design the locomotion of redundant mobile manipulators based on the momentum minimization criteria.
Appropriate trajectory generation for the redundant DOFs robot is necessary in order to fully exploit its capability. This may be achieved by computing the robot joint trajectory from the specified task trajectory via pseudoinverse of the task Jacobian matrix and its null space projection 7 to locally minimize the joint velocity norm and satisfying additional criteria. Chang 8 and Sciavicco and Siciliano 9 introduced an extra task through the corresponding Jacobian matrix that may be augmented to the original task. Joint trajectory is now readily determined by the inverse of the augmented Jacobian matrix. Alternatively, pseudoinverse of the higher priority task Jacobian matrix may be used to compute the joint velocity for higher priority task while lower priority task is implemented through the joint velocity in the respective null space. 10 If the robot input is the actuator torque rather than the velocity, the trajectory generation problem should be considered at the acceleration level. Suh and Hollerbach 11 provided the joint acceleration that locally minimizes the actuator torque norm while tracking the specified task trajectory. Minimization of some integral quantities over the time, known as global minimization problem, was discussed by Suh and Hollerbach, 11 Shiller,12 and Kazerounian and Wang 13 for torque, time-energy, and joint velocity norm, respectively. Nakamura and Hanafusa 14 applied Pontryagin's maximum principle to minimize the integral of the joint velocity norm. Recently, optimal trajectory generation to achieve a set of specified tasks was performed in real time by solving the quadratic programming local optimization problem. 15 Model predictive control approach may be applied to extend the local toward global optimization by solving the constrained optimal problem over a finite horizon. 16 This work proposes the weighted generalized momentum (see the "Momentum minimization" subsection) as optimal criteria in planning the locomotion. In this regard, the coordinating coupled force is utilized to help propel the robot as desired. A method (see subsections "Minimization of new Lagrangian" through "Online determination of the optimal trajectory") to determine the exact optimal solution subject to the tracking task, joint angle, and actuator torque limits is presented. As a result, robot trajectories for different locomotion behaviors according to the specified weighting may be computed online. Required torque will be contributed by all joints cooperatively rather than from merely those at the platform. In addition, the proposed method can be applied to solve a global optimization problem subject to equality and inequality constraints in general.
The article is organized as follows. The second section describes the dynamics of the mobile manipulator and formulates the optimal locomotion generation problem. Rationale of the momentum minimization criteria is explained. In the third section, the optimal system dynamics is derived and a general procedure to compute the optimal solution online subject to equality and inequality constraints is proposed. It is applied to minimize the weighted momentum cost. Simulation and discussion are presented in the fourth section. Finally, conclusions are given in the fifth section.

Dynamic equations
In order to apply the results to general mobile manipulators, detailed realization of the mobile base movement, such as the actuation methods and their arrangement or transmission mechanisms, is not considered. The mobile platform is treated as a rigid body traversing its space. Accordingly, the platform's postural coordinates and manipulator's joint angles are chosen as the generalized coordinates. Such simplification generalizes the following development to any mobile robot. Figure 1 displays the robot structure.
Let fOg and fbg be the fixed frame and base frame attached to the platform at its center of gravity. Position and orientation of fbg with respect to fOg may be described by the Cartesian coordinates, p b ¼ ½x y z T , and unit quaternion, e ¼ ½e 0 e T T ¼ ½e 0 e 1 e 2 e 3 T , as q b ¼ ½p T b e T T 2 R 7 . Configuration of the mounted manipulator may be described by the joint coordinates q m ¼ ½q 1 ; . . . ; q n T 2 R n measuring the relative angle or distance of successive linkages. The ith-link is attached with the frame fig at the joint. q ¼ ½q T b q T m T are the generalized coordinates of the robot.
Velocity of the platform expressed in fbg, where caused by full actuation that is consistent with the k-velocity-level platform nonholonomic constraints. They are related through a constant mapping S 2 R 6Âð6ÀkÞ ; Hence, the corresponding constraints can be describe the platform kinematics. Note that ; EðeÞ À1 ¼ 2 À e e 0 I À ½ eÂ ½ Assume the manipulator is of serial type and has n-DOFs. Motion of the ith-link is caused by motion of the platform and of link 1 to ith. Velocity of its center of gravity (C.G.) expressed in fig, . . . ; q i Þ is the rotation matrix of fig with respect to fbg, b J i m ðq 1 ; . . . ; q i Þ the Jacobian matrix mapping _ q m to b V i , and b J i b ðq 1 ; . . . ; q i Þ ¼ the Jacobian matrix mapping b V b to b V i , of which b p i c =b ðq 1 ; . . . ; q i Þ is the position vector of the C.G. of ith-link with respect to the origin of fbg. Equation (4) describes the manipulator kinematics. Dynamic equations may be determined using the Lagrange formulation. Lagrangian Lðq; _ qÞ of the robot is defined as L ¼ T Ã À U, of which its kinetic co-energy and potential energy are g is the gravitational acceleration vector in fOg, m b and m i the mass of the platform and link i, and are the robot dynamic equations with l be the ðk þ 1Þ-force tuple along the constraints (3). t b 2 R 6Àk and t m 2 R n are the propulsive force and joint torque driving the platform and manipulator. Premultiplying (7) by SðeÞ T and recalling (2) and its derivative (7) and (8) can be reduced to the form of of which Coriolis/centrifugal matrix C r ðe; q m ; _ q r Þ may be derived from the terms M€ q þ C _ q in (9) by applying (2), (10), and using diag SðeÞ; I nÂn ð Þ T to map the related torque. Gravitational torque G r ðe; q m Þ may be computed through G ¼ @U=@q and G r ¼ diag SðeÞ; I nÂn ð Þ T G.

Momentum minimization
Generalized momentum vector P is defined as Dynamically, it indicates the signed accumulation of the applied torque onto the system. Therefore, minimizing the momentum tends to minimize the area under the torque-time graph. Regarding the motion of a multi-DOFs robot, the parts tend to move in opposite direction to each other such that their corresponding momentums cancel and thus minimizing the total momentum. Physically, linkages move cooperatively during locomotion, and corresponding torque required to execute the motion will be incurred to all joints. Hence, the robot is capable of performing challenging motion by proper internal movement as demonstrated in the video 5,6 since its torque capacity has been fully utilized. On the other hand, because T ðq; PÞbP T MðqÞ À1 P=2 is the robot kinetic energy, minimizing the magnitude of P weighted by M À1 implies minimizing the kinetic energy supplied to the robot. Experimental results of natural locomotion in the literature 3,4 support this proposition. From these reasonings, weighted momentum minimization is a viable criteria to resolve the robot redundancy that yields many interesting optimal characteristics.
Control of the robot locomotion to follow desired trajectory while globally minimizing the weighted generalized momentum may be casted as an optimal control problem arg min (9), and X ðq; tÞ ¼ 0 of d-desired trajectory constraints. Since the robot locomotion problem concerns specifying the platform coordinates q b ðtÞ, desired trajectory constraints may be explicitly written as X ðq b ; tÞ ¼ 0.
Weighting matrix W ðqÞ # 0 imposes different weighting or penalty for each component of P. Note that the optimization is global which does not incur the stability problem during long-time trajectory generation. 11,13 In practice, robots have joint angle and actuator torque lower and upper limits, while the joint velocity limit is hardly encountered and thus will be ignored. These inequality constraints may be expressed as for the manipulator n-joint angle limits and all the robot ð6 À k þ nÞ-actuator torque limits. They may be accounted for in the optimal control problem via the Lagrange multipliers.
On minimizing the momentum during locomotion, joint angles will encounter their limits at some instant. In turn, large values of Lagrange multipliers will be induced. Thus, significant counter-torque must be applied to prevent the joint motion from exceeding the limit. Required torque might at worst exceed the actuator torque limit. Even if it still resides in the bound, the magnitude is likely to become unacceptably large. There are several methods to prevent this situation, however. One might employ passive dissipation mechanism to damp out massive energy instead of using the actuator to play the role in impeding the motion. Another is to insert the spring and damper around the manipulator joints in order to keep the arm around a suitable posture away from the joint limits, which also serves as the resting posture after the locomotion has finished. In biological systems, tendons and cartilages around the joints are elements that function as such. However, it would be more convenient for the robot system to implement the spring and damper elements via programmable actuator torques.

Minimization of new Lagrangian
Spring force around the manipulator resting posture q m e during optimal locomotion may be achieved by minimizing the exchange between the momentum cost, _ q T M T W M _ q=2, and the new potential energy, q m À q m e À Á T K p q m À q m e À Á =2, with K p # 0. The resulting motion resembles human natural locomotion in a manner that the limbs deviate more from their resting pose as the trunk accelerates. Pull-back spring forces will prevent the limbs from moving too fast. From the energy viewpoint, part of the kinetic co-energy is transferred to the spring potential. Conversely, when the trunk decelerates, the limbs approach the resting pose by reclaiming the stored potential energy back to the kinetic co-energy. Additionally, if the trunk needs to accelerate in a short period, the stored energy may be retrieved immediately as an extra power helping propel aggressively. For this case, the limbs energetically swing back toward the resting pose as the trunk dynamically moves forward.
Associated joint damping force, K d _ q m , with K d # 0 is introduced as another means to preclude the joint motion from exceeding the limit and to suppress elastic vibration. The optimal problem may now be viewed as globally minimizing the difference of the robot's weighted generalized momentum and the assigned potential energy or the new Lagrangian L n ðq; _ qÞ, subject to (9), X ðq b ; tÞ ¼ 0, (13), (3), and K d _ q m . Optimal torque t Ã ðtÞ may be determined by solving the two-point boundary value problem (TPBVP) which usually is computationally intensive and so cannot be done in real time. Rather than searching for t Ã ðtÞ, the optimal control problem may be viewed as to determine the corresponding optimal trajectory q Ã ðtÞ which extremize the integral subject to the platform constraints and damping force. Instantaneous cost addressing the new Lagrangian, desired trajectory constraints, and joint angle and actuator torque limits is using the Lagrange multipliers c for the cth-desired trajectory constraint, p li / p ui for the ith-joint angle lower/ upper limit, and a lj / a uj for the jth-actuator torque lower/ upper limit. Here, torque constraints are expressed as function of e; q m ; _ q; € q ð Þinstead of e; q m ; _ q r ; € q r ð Þto comply with the generalized coordinates q of the Lagrange formulation. Subscript j of M r , C r , and G r denotes their jth-row.
Note the original joint angle limit (13) is modified to using the Gronwall inequality so that it is related directly to the acceleration or torque. Equation (15) is more restrictive than (13) since if q mi merely converge to Q li or Q ui with the rate exceeding some value proportional to k 1i and k 2i , (15) will become active. Hence, the joint angle limit is represented by (15). Note that fast convergent rate with k 1i and k 2i ) 1 calls for jU li j and jU ui j ) 1 to protect the joint limit intrusion. Indeed, (13) implies that the motion must be stopped immediately as Q li or Q ui has reached, which is not possible since this requires infinite acceleration or deceleration.

Optimal trajectory generation
The optimal problem formulation of determining q Ã ðtÞ resembles the Hamilton's principle of least action, for which calculus of variation 17 may be applied. Specifically, q Ã ðtÞ will be the function that satisfy (16), q Ã ðtÞ must satisfy the following differential equations Substituting Qðq; _ q; € q; tÞ of (14) into (17), one has of which col j ðBÞ ¼ @M rj @q 4 to 7þn € q r þ @C rj @q 4 to 7þn _ q r þ @G rj @q 4 to 7þn and p l = p u , a l = a u , , and l are Lagrange multiplier vectors for joint angle, actuator torque limits, desired trajectory, and platform motion constraints, respectively. In the following, the optimal system dynamics will be derived and a method to determine the optimal trajectory online is proposed.

Optimal system dynamics
Combining (18) with X ðq; tÞ ¼ 0, (3), (15), and (13) results in the differential-algebraic equations (DAEs). The system has q, p l , p u , a l , a u as second-order differential variables and , l as algebraic variables. Since the desired trajectory and platform motion constraints should be satisfied at all time, they may in turn be differentiated twice and once to obtain their acceleration-level equations € X ðq; _ q; € q; tÞ ¼ 0 ð19Þ As a result, the DAEs are transformed into the ordinary differential equations (ODEs) that are much easier to solve. Furthermore, they may be stabilized using the method of Baumgarte 18 to alleviate the constraint drift caused by numerical integration. At any instant, each inequality of (15) and (13) has three possible status; inactive, lower limit, or upper limit active. Each of these is equipped with different constraints, and hence constitutes different dynamics as a part of the optimal hybrid system. Suppose the jth-inequality of the actuator torque limits is inactive. For this case, there is no associated constraint and € a lj ¼ 0 € a uj ¼ 0 with zero initial conditions. However, if the inequality is lower limit active, the constraint ÀM rj € q r À C rj _ q r À G rj þ U lj ¼ 0 from (13) requires that € a uj ¼ 0 with zero initial conditions. a lj may be determined from the dynamics according to this constraint with initial conditions taken from the values of the previous time step. This is the extension of Pontryagin's minimum principle 19 where both the Lagrange multipliers and their time derivatives are involved in the equations of motion. If the ith-inequality of the joint angle limits is lower limit active, the constraint À€ q mi À ðk 1i þ k 2i Þ _ q mi À k 1i k 2i ðq mi À Q li Þ ¼ 0 from (15) requires € p ui ¼ 0 with zero initial conditions. p li is determined from the dynamics associated with this constraint. Inequality with upper limit active may be formulated similarly.
Since there are ð6 À k þ 2nÞ-inequality constraints in (15) and (13), at any instant the system will evolve along one of the 3 6Àkþ2n possible dynamics. The dynamics may switch from one to another as the status of (15) and (13) change; a hybrid system. It is evident that the number of possible dynamics could well be overabundant whereas many of them might never happen during the course. Therefore, an analysis should be performed for each particular system in order to rule out the constraint combinations and dynamics that are unlikely to happen. Some dynamics may possess inconsistent ODEs caused by the conflicts among constraints. Thus, it cannot be solved unless the cost or constraints are modified, or some task requirements are removed temporarily. In this work, conflicting dynamics are handled by relaxing some desired trajectory constraints through setting the respective c ¼ 0, such that the remaining constraints can be satisfied.
In summary, (18) to (20), (15), (13), and the corresponding zero-Lagrange multiplier ODEs constitute the optimal hybrid system dynamics that globally minimize L n subject to the desired trajectory and platform motion constraints, joint angle and actuator torque limits, as well as the manipulator's joint damping force. If the virtual spring and damper are strong enough and the actuator torque limits are adequate to supply the required force, all joint angle and torque limits will be inactive. In that case, (18) becomes and the inequality (15) and (13) yield € p li , € p ui , € a lj , € a uj ¼ 0 with zero initial conditions. Implicitly, the optimal system is not any more hybrid and its dynamics is greatly simplified.

Online determination of the optimal trajectory
Optimal motion q Ã ðtÞ may be determined online as part of solving the optimal dynamics for differential and algebraic variables. Since the system is hybrid, its dynamics may be changing which is not known a priori. Therefore, the inequality constraint status, corresponding system dynamics, and the solution must be determined altogether. A procedure to solve this problem is proposed. First, a constraint status is assumed. System dynamics can then be determined and solved based upon the assumption. According to the solution, the constraint status will be examined if it agrees with what has been assumed. Specifically, for each numerical time step: (1) Initially, assume no active inequality constraint.
Solve the corresponding dynamics. It should be noted that in order to prevent the joint range violation, active joint angle limit may induce active joint torque limit. However, the latter constraint might not be detected at the same iteration as the former. On the other hand, if the robot is equipped with powerful enough actuators, the joint torque limit may not happen. In general, activation of (15) and (13) depends on several factors; desired trajectory, W, K p , K d , and values of the limit themselves. Careful selection helps avoid the constraints, which simplifies determining the optimal trajectory.
To solve the optimal dynamics in the most general setting, the ð20 þ 5n þ d À kÞ-variables of € q, € p l , € p u , € a l , € a u , , l will be extracted from each ODE and collected in that order as a column-tuple Y. For example, (18) having ð7 þ nÞ-ODEs may be arranged as Combining all ODEs arranged in this form together, Y may now be determined by solving the standard matrixvector equation HY ¼ F with a square invertible matrix H of the consistent system and a column-tuple F of the same dimension as Y. Numerical integration may then be applied to solve for q ¼ q Ã , p l , p u , a l , a u , and their firstorder derivatives used in the next time step.
After q Ã ðtÞ has been determined, a robust trajectory tracking controller may be used to compute the required torque with q Ã ðtÞ as reference trajectory input. Figure 2 depicts the overall system diagram. The optimal controller is divided into two parts; optimal trajectory generator and tracking controller. This is in contrast to the optimal control approach which computes t Ã ðtÞ directly by solving a very difficult TPBVP. From the diagram, if the tracking controller can make qðtÞ follow q Ã ðtÞ, the robot closed-loop dynamics will match that of the optimal system. By (18), the closed-loop robot is a Lagrangian system that virtually has the generalized mass of M T W M, the manipulator joint damping K d , and joint spring K p regulating around the resting posture. These parameters may be crafted to achieve desired behavior of the robot. With this new dynamics, the closed-loop robot is subject to the applied torque J T required to track the desired trajectory. Additional torque from the 5th to 10th terms in (18) is activated when the joint angle and/or actuator torque limit is violated. Also, the platform constraints exert torque AðeÞ T l that forces the robot to move along (3).
Until now, q Ã ðtÞ depends on X ðq b ; tÞ ¼ 0, but not on qðtÞ. Numerically, q Ã and its time derivative of the previous time step act as the initial conditions to solve for q Ã at the current time step given q b ðtÞ. q Ã computed in this way may be regarded as the open-loop optimal trajectory since it does not use feedback of the system states. Implicitly, q is assumed to track q Ã exactly at every time step. This might not happen in practice due to, for example, the controller or robot unmodeled dynamics. Consequently, q Ã will merely be the preplanned optimal trajectory. In order to make q Ã be the real-time updated optimal trajectory reflecting the actual tracking error, it should be determined using the robot current states as the initial conditions at every time step, rather than using the optimal states of the previous time step. This modification is shown in Figure 2 as the dashed line feeding back to the trajectory generation module. q Ã is now the adaptive optimal trajectory according to the actual system states. An example of the tracking controller is given and the exponential convergence of qðtÞ to q Ã ðtÞ is proven in Appendix 1.
The proposed framework can be applied to numerically solve any optimal control problem of the mechanical Figure 2. System diagram indicating the separation between the trajectory generation and the tracking controller. Robot current states are used to compute the adaptive optimal trajectory. system online. First, the functions L n and Q must be determined. Next, calculus of variation is applied to solve the extremization of the action I , where a set of ODEs governing the optimal system dynamics is derived. This will be solved for the optimal trajectory, which serves as the input to the tracking controller. The controller will then calculate the torque required to track the optimal trajectory. Such torque is the optimal torque required to optimize L n globally subject to constraints embedded in Q by Lagrange multipliers.

Selection of the weighting matrix
Selection of the weighting or penalty matrix W depends on how one would like to exploit the momentum of different robot parts for the purpose of tracking desired trajectory. Weighting values w ij and w ji of the ði; jÞ and ðj; iÞ-elements in W should be set high if the i and j-generalized momentums, p i and p j , will be barely utilized. Then, because p i ¼ P 7þn k¼1 m ik ðqÞ _ q k , generalized velocities which highly influence the momentum will be of little values. Consequently, motion of the parts pertaining to these velocities will become small. Conversely, if one would like to utilize the motion of a robot part corresponding to the generalized velocity _ q for tracking desired trajectory, its generalized momentum p ¼ MðqÞ _ q should be computed and the dominant l-component p l be determined. Thus, weighting elements of W involving p l should be set to low values as they will incur small penalty on this motion, encouraging the part to move.
Remark that if W ¼ M À1 , the closed-loop robot mass will be the same as the open-loop one. This implies that the natural motion, or motion of the open-loop robot itself with no influence from external force, attempts to globally minimize the robot momentum weighted by M À1 , which is also the open-loop robot kinetic energy. Hence, by choosing W ¼ M À1 , the energy supplied to the robot is the minimal kinetic energy for tracking the desired trajectory. Generally, one can shape the closed-loop robot mass M n 1 0 arbitrarily by choosing W ¼ M À1 M n M À1 . If M n is a constant diagonal matrix, the closed-loop dynamics will be fully decoupled. Nevertheless, the weighting should also be chosen taking the robot mass distribution and joint angle/torque limit into account so the optimal trajectory is realizable. Roughly speaking, the more the deviation of M n from M, the more additional torque is required for mimicking the inertial force of the optimal system.

Simulation
In this section, the proposed optimal locomotion generator and tracking controller (2A) and (3A) are applied to a cartpole robot. The system in Figure 3 serves as an instructive example since its motion is comparable to gross human locomotion and important results can be observed clearly.
The cart mass M is 10 kg while that of the pole m is 5 kg. Its C.G. is located at l c ¼ 0:3 m from the joint and the inertia about the C.G. is I ¼ 0:15 kg m 2 . Because the cart movement is constrained to simple rectilinear motion, desired locomotion of the platform may be specified by x d ðtÞ with the platform constraint vanished. In other words, q ¼ x; q ½ T and the system dimension is reduced to 2. The robot dynamics may be derived as and their numerical values are 15, 1:5, 0:6, and 14:7. t b and t m are the driving force and linkage torque exerted along the xand q-coordinate. Therefore, the robot is redundant and the pole movement in the range q 2 ½p=6; 5p=6 may be exploited to assist the locomotion task.
Assume t b max ¼ 400 N and t m max ¼ 100 Nm. Set K d ¼ 15 Nm s/rad and K p ¼ 15 Nm/rad with q e ¼ p=2 rad for the joint spring/damper, and k 1q ¼ k 2q ¼ 50 for the joint limit constraints. The controller gains used are K ¼ diagð10; 10Þ and G ¼ diagð5; 5Þ. Figure 4 shows the desired locomotion x d ðtÞ (solid line) which imitates the human C.G. motion during walking with varying footstep lengths for 5 s.
Robot trajectory, supplied torque, and work input to the robot are plotted in Figures 4 and 5 using W ¼ M À1 and W ¼ diagð0:5; 0:5Þ. In both cases, the robot is able to track x d . However, different behaviors are observed. When W ¼ M À1 is adopted, the link does not swing much because its inertia is very small compared to the platform. Little contribution to the locomotion can be made by the link and thus natural motion decides not to move the link too much. On the other hand, if W ¼ diagð0:5; 0:5Þ is used, the link will swing much more in opposite direction to € x d , in an attempt to minimize the generalized momentum according to the new weighting. This is achieved by intentionally swinging the link with t m % 50 Nm such that the induced coupling force is exploited to assist the locomotion meaningfully. From the graphs, average value of t b will be lessened from 200 N when using natural dynamics to 100 N. Moreover, the peak value caused by tracking aggressive locomotion during 2-3 s is reduced from 320 N to 160 N. This indicates that the robot is capable of performing more challenging tasks by utilizing all actuators through internal motion of robot linkages according to minimizing the properly weighted generalized momentum as discussed in the "Selection of the weighting matrix" subsection. Total work driving the robot when natural dynamics is exploited is of course the least among all weightings.
Other parameters play a role in designating the robot closed-loop behavior as well. The aim of joint spring and damper is to prevent and stabilize linkage motion from exceeding the joint limit. Even more, the spring is a crucial element to fast motion in a short period. Yet they contort the momentum minimization objective and its benefits. Joint angle and torque limits affect the robot behavior too. When the constraint is active, abrupt large force is required to prevent constraint violation. This ruins the momentum minimization objective. Therefore, the limits should be high enough so that minimizing the momentum can be truly achieved within the full operating range. Lastly, the robot design itself has an impact on its closed-loop behavior. A guideline might be to design the robot with M close to M n and to employ desired passive spring/dampers. Thus, the robot natural dynamics will be utilized primarily, together with complementary actuator torque, to execute the task with optimal dynamics in the absence of active inequality constraints.

Conclusions
This article presents a formal method to exploit the movement of the manipulator in assisting the locomotion of the mobile robot platform by globally minimizing the weighted generalized momentum. Resulting cooperative motion of the manipulator and platform induces the coupling force which helps propel the robot. Degree of the utilization may be adjusted through the momentum weighting parameters. Notably, the robot exploits its natural dynamics if W ¼ M À1 is chosen. The locomotion is modest and requires minimal input work. On the contrary, additional work is needed using other weightings. With certain weightings that produce suitable coordinating motion patterns, the robot may be able to conquer challenging motion under practical constraints. To summarize, global minimization of the weighted generalized momentum causes the redundant robot to perform specified tasks with desirable behavior governed by newly shaped optimal dynamics subject to motion and actuation constraints.

Declaration of conflicting interests
The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Funding
The author(s) received no financial support for the research, authorship, and/or publication of this article.