# US 2026/0273739 A1 · Controlling Stability of Mobile Manipulators by Dynamic Arm Motions

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2026/0273739 A1
- Document ID: US20260273739A1
- Status: Published application
- Kind: A1
- Application number: 19/669,292
- Filed: 2026-05-06
- Published: 2026-09-17
- Earliest claimed: 2023-11-08
- Assignees: ABB Schweiz AG
- Applicants: ABB Schweiz AG
- Inventors: Arne-Christoph Hildebrandt; Jonas Larsson; Christoph Bick
- Web page: https://patentgrep.com/patent/US20260273739A1

## CPC

- B25J 9/162: {Mobile manipulator, movable base with manipulator arm mounted on it}
- B25J 9/1638: {compensation for arm bending/inertia, pay load weight/inertia}
- B25J 5/007: {mounted on wheels}
- G05D 1/498: {involving adjustment of the relative position of the centre of gravity of the vehicle}
- G05B 2219/39172: Vehicle, coordination between manipulator arm and its moving vehicle
- G05B 2219/40298: Manipulator on vehicle, wheels, mobile
- G05D 2105/45: for manufacturing, maintenance or repairing
- G05D 2107/68: {Research centers or laboratories}
- G05D 2109/10: Land vehicles
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A method for controlling a mobile manipulator includes determining a current configuration of the mobile manipulator, determining a desired movement trajectory of the mobile manipulator, determining a current zero-movement points (ZMP) trajectory, determining a desired ZMP trajectory of the mobile manipulator, adjusting the mobile manipulator such that the current ZMP trajectory corresponds to the desired ZMP trajectory, wherein adjusting comprises moving a manipulator arm controlled by: f ⁡ ( Z ⁢ M ⁢ P real ( q ¨ M , q ˙ M , q M , t ) , ZM ⁢ P d ⁢ e ⁢ s ( t ) ) = min ⁢ e wherein “ZMPdes(t)” is the desired ZMP trajectory; “ZMPreal” is the real ZMP trajectory; “t” is a time; “{umlaut over (q)}m,{dot over (q)}M,qM,” are joint states of acceleration, velocity and position of the manipulator arm (5); and “e” is a deviation of the real ZMP trajectory from the desired ZMP trajectory.

## Claims

### Claim 1

A method for controlling a mobile manipulator comprising a manipulator base and at least one manipulator arm, the method comprising:
determining a current configuration of the mobile manipulator including a manipulator arm configuration and a manipulator base configuration;
determining a desired movement trajectory of the mobile manipulator;
determining a current zero-movement points (ZMP) trajectory, comprising the location of one or more current ZMP of the mobile manipulator, based on the current configuration of the mobile manipulator and the desired movement trajectory;
determining a desired ZMP trajectory of the mobile manipulator, wherein each ZMP is located within a support polygon of the manipulator base;
adjusting the mobile manipulator such that the current ZMP trajectory corresponds to the desired ZMP trajectory;
wherein the step of adjusting the mobile manipulator comprises a dynamic manipulator arm movement, which is controlled by the following first control function:
f
⁡
(
Z
⁢
M
⁢
P
real
(
q
¨
M
,
q
˙
M
,
q
M
,
t
)
,
Z
⁢
M
⁢
P
d
⁢
e
⁢
s
(
t
)
)
=
m
⁢
i
⁢
n
⁢
e
,
wherein “ZMPdes(t)” is the desired ZMP trajectory; “ZMPreal” is the real ZMP trajectory; “t” is a time; “{umlaut over (q)}M,{dot over (q)}M,qM,” are joint states of acceleration, velocity and position of the manipulator arm; and “e” is a deviation of the real ZMP trajectory from the desired ZMP trajectory.

### Claim 2 (depends on 1)

The method according to claim 1, wherein the method further comprises the step of using “q0, {dot over (q)}0, {umlaut over (q)}0” as input variables for the first control function, wherein “q0, {dot over (q)}0, {umlaut over (q)}0” are the initial states of position, velocity and acceleration of the mobile manipulator.

### Claim 3 (depends on 1)

The method according to claim 1, wherein the method further comprises using the first control function to adjust one or more of the position, velocity and acceleration of the manipulator arm to adjust the mobile manipulator such that the real ZMP trajectory of the mobile manipulator corresponds to the desired ZMP trajectory.

### Claim 4 (depends on 1)

The method according to claim 1, further comprising obtaining from the first control function the joint accelerations of the manipulator arm “{umlaut over (q)}M” as an output, and executing a movement trajectory of the mobile manipulator based on that output.

### Claim 5 (depends on 4)

The method according to claim 4, wherein, after executing a movement trajectory of the mobile manipulator based on that output, the method further comprises using the joint states of position and velocity “qM, {dot over (q)}M” as an input for the first control function.

### Claim 6 (depends on 1)

The method according to claim 1, adjusting the mobile manipulator is based on the following second control function:
∫
f
⁡
(
Z
⁢
M
⁢
P
real
(
q
¨
M
,
q
˙
M
,
q
M
,
t
)
,
Z
⁢
M
⁢
P
d
⁢
e
⁢
s
(
t
)
)
⁢
d
⁢
s
=
m
⁢
i
⁢
n
⁢
e
,
wherein the joint accelerations of the manipulator arm “{umlaut over (q)}M” is used as an input variable for the second control function.

### Claim 7 (depends on 6)

The method according to claim 6, further comprising obtaining from the second control function the desired state of the manipulator arm “({umlaut over (q)}M, {dot over (q)}M, qM)des(t)” as an output.

### Claim 8 (depends on 7)

The method according to claim 7, wherein the output of the second control function is used as an input to adjust the mobile manipulator such that the real ZMP trajectory of the mobile manipulator corresponds to the desired ZMP trajectory.

### Claim 9 (depends on 7)

The method according to claim 7, wherein wherein the output of the second control function is used as an input for the first control function.

### Claim 10 (depends on 1)

The method according to claim 1, wherein the mobile manipulator comprises one or more variable mass elements, and wherein adjusting a center of mass of the mobile manipulator includes an adjustment of the variable mass elements.

### Claim 11 (depends on 10)

The method according to claim 10, wherein the method further comprises using a discrete mass parameter as an input variable for the first control function and/or the second control function.

### Claim 12 (depends on 1)

The method according to claim 1, wherein adjusting the mobile manipulator comprises a dynamic movement, which is controlled by the following second control function:
∫
f
⁡
(
Z
⁢
M
⁢
P
real
(
q
,
q
˙
,
q
¨
,
t
)
,
Z
⁢
M
⁢
P
d
⁢
e
⁢
s
(
t
)
)
⁢
d
⁢
s
=
m
⁢
i
⁢
n
⁢
e
,
wherein “q, {dot over (q)}, {umlaut over (q)}” are the joint states of position, velocity and acceleration of the mobile manipulator, and wherein the mobile manipulator comprises a tool center point (TCP); and
wherein the TCP is controlled to execute a TCP-trajectory according to the following function:
f
⁡
(
q
,
q
˙
,
q
¨
,
t
)
=
x
T
⁢
C
⁢
P
(
t
)
,
wherein χTCP(t) is the TCP-trajectory, and wherein the TCP-trajectory is used to determine the desired ZMP trajectory “ZMPdes(t)”.

### Claim 13

A mobile manipulator, comprising:
a manipulator base;
at least one manipulator arm; and
a control means adapted to control the mobile manipulator in accordance with a method for controlling a mobile manipulator comprising a manipulator base and at least one manipulator arm, the method comprising:
determining a current configuration of the mobile manipulator including a manipulator arm configuration and a manipulator base configuration;
determining a desired movement trajectory of the mobile manipulator;
determining a current zero-movement points (ZMP) trajectory, comprising the location of one or more current ZMP of the mobile manipulator, based on the current configuration of the mobile manipulator and the desired movement trajectory;
determining a desired ZMP trajectory of the mobile manipulator, wherein each ZMP is located within a support polygon of the manipulator base;
adjusting the mobile manipulator such that the current ZMP trajectory corresponds to the desired ZMP trajectory;
wherein the step of adjusting the mobile manipulator comprises a dynamic manipulator arm movement, which is controlled by the following first control function:
f
⁡
(
Z
⁢
M
⁢
P
real
(
q
¨
M
,
q
˙
M
,
q
M
,
t
)
,
ZM
⁢
P
d
⁢
e
⁢
s
(
t
)
)
=
m
⁢
i
⁢
n
⁢
e
wherein “ZMPdes(t)” is the desired ZMP trajectory; “ZMPreal” is the real ZMP trajectory; “t” is a time; “{umlaut over (q)}M,{dot over (q)}M,qM,” are joint states of acceleration, velocity and position of the manipulator arm; and “e” is a deviation of the real ZMP trajectory from the desired ZMP trajectory.

### Claim 14 (depends on 13)

The mobile manipulator according to claim 13, wherein the mobile manipulator additionally comprises one or more variable mass elements that are adjustable to adjust a center of mass of the mobile manipulator.

### Claim 15 (depends on 13)

The mobile manipulator according to claim 13, wherein the mobile manipulator is an industrial autonomous mobile manipulation robot comprising more than two steerable wheels.

### Claim 16

A computer-readable medium comprising instructions which, when executed by a computer, cause the computer to carry out a method for controlling a mobile manipulator comprising a manipulator base and at least one manipulator arm, the instructions comprising:
instructions for determining a current configuration of the mobile manipulator including a manipulator arm configuration and a manipulator base configuration;
instructions for determining a desired movement trajectory of the mobile manipulator;
instructions for determining a current zero-movement points (ZMP) trajectory, comprising the location of one or more current ZMP of the mobile manipulator, based on the current configuration of the mobile manipulator and the desired movement trajectory;
instructions for determining a desired ZMP trajectory of the mobile manipulator, wherein each ZMP is located within a support polygon of the manipulator base;
instructions for adjusting the mobile manipulator such that the current ZMP trajectory corresponds to the desired ZMP trajectory;
wherein the step of adjusting the mobile manipulator comprises a dynamic manipulator arm movement, which is controlled by the following first control function:
f
⁡
(
Z
⁢
M
⁢
P
real
(
q
¨
M
,
q
˙
M
,
q
M
,
t
)
,
Z
⁢
M
⁢
P
d
⁢
e
⁢
s
(
t
)
)
=
m
⁢
i
⁢
n
⁢
e
wherein “ZMPdes(t)” is the desired ZMP trajectory; “ZMPreal” is the real ZMP trajectory; “t” is a time; “{umlaut over (q)}M,{dot over (q)}M,qM,” are joint states of acceleration, velocity and position of the manipulator arm; and “e” is a deviation of the real ZMP trajectory from the desired ZMP trajectory.
