Choi 2020
Choi 2020
REGULAR PAPER
Received: 10 October 2019 / Revised: 5 December 2019 / Accepted: 15 December 2019 / Published online: 2 January 2020
© Korean Society for Precision Engineering 2020
Abstract
This paper introduces the concept of motion planning of delivery robot in an autonomous driving mode using an inverted
pendulum model that can effectively control disturbance. The inverted pendulum model exhibits the non-minimum phase
characteristic caused by the right half-plane zero. An effective method of reducing this characteristic is examined. A motion
platform with 3-degree-of-freedom motion and a touch sensor are installed on a wheeled omnidirectional mobile platform.
A steel ball is placed on the touch sensor and controlled to be located at the center. As the autonomous delivery robot moves,
the steel ball is subjected to various disturbances and goes off the center. The influence of disturbance can be predicted by
measuring the distance the steel ball moves away from the center. In this paper, linear quadratic regulator, preview control,
and model predictive control are applied to the inverted pendulum model for motion planning, and thus the reduction of the
non-minimum phase characteristic can be comparatively analyzed via simulation. The decrease in the disturbance is experi-
mentally compared according to motion planning. Consequently, this paper proposes an effective motion planning method
for an autonomous delivery robot with non-minimum phase characteristic.
13
Vol.:(0123456789)
884 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
paper, we aim to address the issue of the low velocity of cur- force was compensated by the motion planning methods.
rently operating delivery robots and to develop an autono- The performance of the motion planning by linear quadratic
mous delivery robot with a motion planning technology for regulator (LQR) and MPC respectively was tested to deter-
fast and stable delivery. Figure 1 shows conceptual images mine which control method was most appropriate for the
of the robot. One is a differential drive mobile platform, and autonomous delivery robots.
the other is an omnidirectional mobile platform.
The acceleration applied to a load is controlled in real-
time by calculating the tilt angle of a motion platform. Con- 2 Inverted Pendulum Model
sidering this, we designed a controller based on an inverted
pendulum model. If a torque is not applied to the inverted 2.1 B‑POR (Ball‑Plate Omni Robot)
pendulum, the zero-moment point (ZMP) is always located
at the center of rotation. Thus, when the system is con- As shown in Fig. 2, ball-plate omni robot (B-POR) consisted
trolled by maintaining ZMP at 0, it can achieve stability of two modules and was developed as a miniature test plat-
under situations with various accelerations. However, the form [15]. A mobile platform with omnidirectional wheels
inverted pendulum model with no direct torque is basically constituted the lower part (base) and a motion platform
an underactuated system and thus shows non-minimum
phase characteristic. Accordingly, undesired undershoot
occurs when the system is controlled. To prevent this situ-
ation, various studies have been conducted [1–4]. Control
using a planned motion trajectory can be effective in reduc-
ing the non-minimum phase characteristic of the inverted
pendulum model. This method typically adopts the preview
control [5–8] and model predictive control (MPC) [9–14]
as the control techniques. To verify the method, the perfor-
mance of each controller was tested using an experimental
platform that was smaller than the real autonomous delivery
robot. The experimental platform was an omnidirectional
robot equipped with a 3 degree-of-freedom (DOF) motion
platform. The motion platform had a resistive touch sen-
sor. The position of a steel ball on the touch sensor can be
measured in real-time. In the experiment, during autono-
mous movement of the platform, the position of the ball
was measured to determine how effectively the accelerating Fig. 2 Ball-plate omni robot
Fig. 1 Conceptual images of
two types of high-speed autono-
mous delivery robots
13
International Journal of Precision Engineering and Manufacturing (2020) 21:883–894 885
mc kg 2 Mass of cart
mp kg 0.5 Mass of pendulum
lp m 0.12 Length of CoM of pendulum
Fig. 3 Cart inverted pendulum model
13
886 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
u = Klqr (xref − x) (3) approximately 2 s. For this reason, there is an error of the
initial position and the actual behavior has an undesired
where reverse action. Such a reverse action corresponds to the non-
[ ]T minimum phase characteristic that is typical of systems with
xref = 0 ṗ des 0 0 . a zero point in the right half-plane [24–27]. Accordingly, the
preview control and MPC were proposed to minimize the
The cost function for the LQR gain is expressed as non-minimum phase characteristic.
follows:
∞
∫0
J= (xT Qx + uT Ru) (4) 3.2 Preview Control
Fig. 4 LQR simulation
13
International Journal of Precision Engineering and Manufacturing (2020) 21:883–894 887
T ( )−1
state-space equation is expressed as x̃ k = [ ek xk ] and Gdk = R + B̃ T P̃ B̃ B̃ T X̃ k−1
the discrete-time state-space equation can be arranged as ( ) (12)
X̃ k = Ã Tc X̃ k−1 l = 2, … , NL
follows.
[ ] [ ] where à c = à − B̃ K,
̃ Gd = GI , X̃ 1 = −Ã T P̃ C̃ T . The preview
[ ] 1 c
̃A = I Cd Ad
, B=̃ Cd Bd
, C̃ = 1 01×4 (7) control simulation was conducted for the motion planning of
0 Ad Bd the inverted pendulum model. In this simulation, the number
where the tracking error, ek is yk − yk , and the optimal con-
ref of preview samples, NL was 150, and the control interval was
trol problem can be constructed to minimize the following 100 Hz. The weight parameters were set as follows.
cost function. ⎡ 0.01 0 0 0⎤
∑[
∞
] ̃ x = ⎢⎢ 0
̃ e = 10, Q 0.1 0 0⎥
R = 1e−4
0 ⎥⎥
Q ,
J= eTi Qe ei + 𝛥xiT Qx 𝛥xi + 𝛥uTi R𝛥ui (8) ⎢0 0 1
i=k ⎣0 0 0 1⎦
Here, the optimal control equation is given as follows: As shown in the simulation result of Fig. 5, when the pre-
view control was applied to the inverted pendulum model, the
∑
k
∑
NL
uk = −GI ei − Gx xk −
ref
Gdi yk+i (9) control input was created at 0.5 s, which is 1.5 s ahead of
i=1 i=1 the time when the step input started and tracked the reference
input. Given that the preview control tracks the reference input
where NL is the number of preview samples and the gain is
in advance, the undershoot can be reduced. However, con-
obtained as the solution of the following algebraic Riccati
sidering that the future input should be known, the preview
equation.
control is available only when the reference input is predeter-
( )−1 mined for a period of at least 1.5 s from a given time. In case a
P = Ã T P̃ Ã − Ã T P̃ B̃ R + B̃ T P̃ B̃ B̃ T P̃ Ã + Q
̃ (10)
humanoid robot’s walking pattern is created using the preview
{ }
Here, the weight is Q ̃ = diag Qe , Qx , from which the fol- control, the parameter is determined beforehand. As such, this
lowing optimal gain is obtained. a control method is advantageous. The position tracking per-
formance was drastically improved compared to the case when
[ ] ( )−1
K̃ = GI Gx = R + B̃ T P̃ B̃ B̃ T P̃ Ã (11) the LQR control was used. Nevertheless, a slight undershoot
and overshoot were observed with respect to velocity tracking.
In addition, the optimal preview gain is calculated by the Although various weight parameters and a different number of
following recursive formulas: preview samples were applied to the simulation, similar results
13
888 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
13
International Journal of Precision Engineering and Manufacturing (2020) 21:883–894 889
Fig. 7 DMPC simulation
4 Experiment
4.1 Experimental Platform
13
890 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
13
International Journal of Precision Engineering and Manufacturing (2020) 21:883–894 891
applied, the steel ball was controlled with an RMS value of was experimentally demonstrated that the MPC motion plan-
approximately 4 mm, which was close to 3 mm or the control ning achieved more reliable control than the LQR motion
level in the stationary condition. As illustrated in Fig. 15, planning. The experimental video is available online [29].
when MPC was used, the rectangular trajectory was smoothly
tracked with no deviation from the corner. Consequently, it
13
892 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
13
International Journal of Precision Engineering and Manufacturing (2020) 21:883–894 893
with respect to reducing the non-minimum phase charac- the rotational movement is not considered. For the rotation
teristic of the inverted pendulum model. The performance in place, the problem is not significant because it does not
of the MPC motion planning was demonstrated by both produce lateral acceleration, but in the case of turning, the
simulation and experiment. In the experiment, while the centrifugal acceleration may occur and become a problem.
steel ball was stabilized using the PID control, its posi- This issue requires more complex models and interpreta-
tion was measured to indirectly identify acceleration of tions. In the author’s past paper [24], I conducted a study
the steel ball during movement. The experimental result using double inverted pendulum, which enabled better object
revealed that the MPC motion planning ensured much stabilization and the rotational movement is considered.
more stable control and the accelerations were effectively However, the paper had limitations that are limited to LQR
compensated during movement. control. So, I have a plan to apply the MPC motion planning
The main reason why the MPC performs better is because to double inverted pendulum model for more sophisticated
it uses the future command information in advance. This stabilization performance. Finally, the performance of the
inevitably leads to lower real-time performance. The MPC MPC motion planning needs to be demonstrated in a real
motion planning used in this paper did not adopt any con- autonomous delivery robot in the future.
straint. The real-time performance of the MPC motion plan-
ning can be further improved by applying constraints. If con- Acknowledgements This work was supported by 2018 Research Fund
of Myongji University.
straints are applied, a delivery robot could be controlled to
quickly avoid a sudden obstacle in real-time.
In this paper, the single inverted pendulum model is used
to represent the system with minimal degree of freedom.
A more appropriate model would be double inverted pen-
References
dulum to model the movement of the steel ball. And also, 1. Choi, D., & Oh, J. (2012). ZMP stabilization of rapid mobile
manipulator. In Proceedings of the IEEE international conference
on robotics and automation (ICRA) (pp. 883–888). IEEE.
Table 2 Root-mean-square (RMS) value of ball position 2. García, P., Albertos, P., & Hägglund, T. (2016). Control of unsta-
ble non-minimum-phase delayed systems. Journal of Process
Motion PID LQR MPC Control, 16(10), 1099–1111.
Stationary Rectangular Rectangular 3. Nakamura, R., & Amino, A. (2017). Perfect tracking control using
a phase plane for a wheeled inverted pendulum under hardware
X-axis (mm) 3.19 8.81 4.11 constraints. In Proceedings of the IEEE international conference
Y-axis (mm) 3.33 6.61 4.15 on robotics and automation (ICRA) (pp. 4377–4382). IEEE.
13
894 International Journal of Precision Engineering and Manufacturing (2020) 21:883–894
4. Dallali, H., Brown, M., & Vanderborght, B. (2009). Using the 20. Jørgensen, V. (1974). A ball-balancing system for demonstration
torso to compensate for non-minimum phase behaviour in ZMP of basic concepts in the state-space control theory. International
bipedal walking. In T. Kröger & F. M. Wahl (Eds.), Advances in Journal of Electrical Engineering Education, 11(4), 367–376.
robotics research (pp. 191–202). Berlin: Springer. 21. Choi, D., & Oh, J. (2008). Human-friendly motion control of
5. Katayama, T., Ohki, T., Inoue, T., & Kato, T. (1985). Design of an a wheeled inverted pendulum by reduced-order disturbance
optimal controller for a discrete-time system subject to preview- observer. In 2008 IEEE international conference on robotics and
able demand. International Journal of Control, 41(3), 677–699. automation (ICRA) (pp. 2521–2526). IEEE.
6. Akachi, K., Kaneko, K., Kanehira, N., Ota, S., Miyamori, G., 22. Choi, D., Oh, J. H. (2011). Four and two wheel transformable
Hirata, M., et al. (2005). Development of humanoid robot HRP- dynamic mobile platform. In 2011 IEEE international conference
3P. In 5th IEEE-RAS international conference on humanoid robots on robotics and automation (ICRA) (pp. 1–4). IEEE.
(pp. 50–55). IEEE. 23. Kim, M., & Choi, D. (2019). Design and development of a vari-
7. Kajita, S., Kanehiro, F., Kaneko, K., Fujiwara, K., Harada, K., able configuration delivery robot platform. International Journal
Yokoi, K., et al. (2003). Biped walking pattern generation by using of Precision Engineering and Manufacturing, 20(10), 1757–1765.
preview control of zero-moment point. In 2003 IEEE international 24. Choi, D., & Oh, J. (2014). Motion planning for a rapid mobile
conference on robotics and automation (ICRA) (pp. 1620–1626). manipulator using model-based ZMP stabilization. Robotica. https
IEEE. ://doi.org/10.1017/S0263574714002501.
8. Cho, B.-K., & Kim, J.-Y. (2018). Dynamic posture stabilization of 25. Choi, D., Kim, M., & Oh, J. H. (2012). Development of a rapid
a biped robot SUBO-1 on slope-changing grounds. International mobile robot with a multi-degree-of-freedom inverted pendulum
Journal of Precision Engineering and Manufacturing, 19(7), using the model-based zero-moment point stabilization method.
1003–1009. Advanced Robotics, 26(5–6), 515–535.
9. Holkar, K. S., & Waghmare, L. M. (2010). An overview of model 26. Kim, M., Choi, D., & Oh, J. H. J. (2010). Stabilization of a
predictive control. International Journal of Control and Automa- rapid four-wheeled mobile platform using the ZMP stabiliza-
tion, 3(4), 47–63. tion method. In 2010 IEEE/ASME international conference on
10. Pannocchia, G., & Rawlings, J. B. (2003). Disturbance models advanced intelligent mechatronics (AIM) (pp. 317–322). IEEE.
for offset-free model-predictive control. AIChE Journal, 49(2), 27. Canete, L., & Takahashi, T. (2014). Development of a single
426–437. controller for the compensation of several types of disturbances
11. Wieber, P.-B. B. (2006). Trajectory free linear model predictive during task execution of a wheeled inverted pendulum assistant
control for stable walking in the presence of strong perturbations. robot. In 2014 IEEE/RSJ international conference on intelligent
In 2006 6th IEEE-RAS international conference on humanoid robots and systems (IROS) (pp. 2414–2420). IEEE.
robots (pp. 137–142). IEEE. 28. Kajita, S., Morisawa, M., Harada, K., Kaneko, K., Kanehiro, F.,
12. Giselsson, P. (2009). Model predictive control in a pendulum sys- Fujiwara, K., et al. (2006). Biped walking pattern generator allow-
tem. In 2009 American control conference (pp. 2335–2340). ing auxiliary ZMP control. In 2006 IEEE/RSJ international con-
13. Lafaye, J., Collette, C., & Wieber, P. B. (2015). Model predictive ference on intelligent robots and systems (IROS) (pp. 2993–2999).
control for tilt recovery of an omnidirectional wheeled humanoid IEEE.
robot. In 2015 IEEE international conference on robotics and 29. [Experiment] Ball Plate Omni Robot. (2019). Retrieved December
automation (ICRA) (pp. 5134–5139). IEEE. 5, 2019, from https://youtu.be/WEnwpPVgp6Q.
14. Lim, H., et al. (2014). Experimental verification of nonlinear
model predictive tracking control for six-wheeled unmanned Publisher’s Note Springer Nature remains neutral with regard to
ground vehicles. International Journal of Precision Engineering jurisdictional claims in published maps and institutional affiliations.
and Manufacturing, 15(5), 831–840.
15. Choi, D., Kim, M., Kim, H., Choe, J., & Nah, M. C. (2018). Real-
time motion planning of autonomous personal transporter using
model predictive control for minimizing non-minimum phase Dongil Choi received BS, MS,
motion. In 2018 15th international conference on ubiquitous Ph.D degrees in Mechanical
robots (UR) (pp. 362–368). IEEE. E n g i n e e r i n g f r o m Ko r e a
16. Zeeshan, A., Nauman, N., & Jawad Khan, M. (2012). Design, Advanced Institute of Science
control and implementation of a ball on plate balancing system. and Technology (KAIST), in
In Proceedings of 2012 9th international Bhurban conference on 2005, 2007, 2012, respectively.
applied sciences and technology (IBCAST) (pp. 22–26). IEEE. He is currently a professor at
17. Awtar, S., Bernard, C., Boklund, N., Master, A., Ueda, D., & Myongji University. His research
Craig, K. (2002). Mechatronic design of a ball-on-plate balancing interests include design and con-
system. Mechatronics, 12(2), 217–228. trol of autonomous robot, legged
18. Fan, X., Zhang, N., & Teng, S. (2004). Trajectory planning and robot and mobile manipulator.
tracking of ball and plate system using hierarchical fuzzy control
scheme. Fuzzy Sets and Systems, 144(2), 297–312.
19. Fabregas, E., Chacón, J., Dormido-Canto, S., Farias, G., & Dor-
mido, S. (2015). Virtual laboratory of the ball and plate system.
IFAC-PapersOnLine, 48(29), 152–157.
13