Preprint
Article

Kinematic Model based Control of Spherical Mobile Robot with Under-Actuated System

Altmetrics

Downloads

99

Views

23

Comments

0

This version is not peer-reviewed

Submitted:

20 July 2023

Posted:

21 July 2023

You are already at the latest version

Alerts
Abstract
This paper introduces an alternative method to design the path following controller of an under-actuated spherical mobile robot, which has a single pendulum structure its inside as a driving mechanism. The mechanism has an under-actuated problem; two inputs for the roll and pitch but no direct input for the yaw. In order to overcome this problem, the proposed method defines a virtual reference input for the heading direction. The virtual reference input works as a control input since it can be arbitrarily designed just like the reference input of a conventional system. The control scheme using the defined virtual reference input achieves the stabilization and path following control of the under-actuated spherical mobile robot without any additional control technique. The stability of the proposed control scheme is guaranteed by Lyapunov stability analysis, and simulation results are given to demonstrate its performance.
Keywords: 
Subject: Engineering  -   Control and Systems Engineering

1. Introduction

In the last few decades, the spherical mobile robot has been researched widely because it has more points of excellence from its body mechanism such as no body extremities (fully enclosed design), a statically stable structure, less friction, easy recovery from collisions and so on. These advantages, especially the stable structure and easy recovery from collision make the spherical robot land and work in the unmanned and uncertain environment as an exploration rover. [1,2,3,4,5]
Although almost all spherical mobile robots have the same external structure, they have different types of the internal structure for driving. Cai et al. introduced a single pendulum structure, which has two operating units; one performs driving and the other controls the pendulum, [6] and Zhao et al. proposed two pendulum mechanism. It has three operating units consisting of one driving unit and two control units for each pendulum. [7] DeJong et al. studied the four-pendulum mechanism without a driving unit [8] In addition, the cart-type spherical mobile robot is driven by inserting a cart inside the spherical mobile robot. The cart-type spherical mobile robot has been modified in various ways depending on the type of cart. [9,10,11,12]
Among the various types of spherical mobile robots, the single pendulum spherical mobile robot is easy to implement due to its simple structure. Therefore, many studies have been conducted on these single pendulum spherical mobile robots; Qiang et al. dealt with the dynamic trajectory tracking problem of a spherical mobile robot using a backstepping controller. [13] Yue et al. dealt with the problem of overcoming rolling resistance using sliding mode control after deriving a dynamic model of a spherical mobile robot. [14] Kayacan et al. proposed a study on a dynamic modeling using Euler-Lagrange and a feedback linearization control technique based on a fuzzy controller. [15] Andani et al. estimated the angle of the pendulum through a neural network observer and proposed tracking control of the spherical mobile robot after removing the model uncertainty by a sliding mode controller. [16]
Most of the previous studies mentioned above have dealt with the rolling motion control of spherical mobile robots. However, the important control object of spherical mobile robots is to solve the underactuation problem, which causes the degradation of the control performance and the deterioration of the stability. [17] Studies have been conducted on hierarchical sliding mode controllers to address these under-actuated problems. [18] The hierarchical sliding mode control method can solve the under-actuated problem by setting up a hierarchical structure using sliding surfaces and maintain robustness against uncertainty. However, there is a problem that the sliding surface for each subsystem may not converge to zero even if the sliding surface of the total system converges to zero. As a result, the anti-disturbance ability of sliding mode control might be lost. [19,20] Therefore, we present an alternative method to solve the under-actuated problem.
In this paper, we propose a virtual control input based nonlinear control method for the path following of an under-actuated spherical mobile robot. In order to control the uncontrollable state without an input terminal, a virtual reference input is substituted for the conventional reference input. The virtual reference input is designed at will by a designer. Therefore, if the virtual reference input is applied identically to the design of the control input, it operates as another control input for controlling the uncontrollable state. Not only the parallel motion of the X-Y plane but also the yaw of the spherical mobile robot are controlled by the proposed method. The proposed method does not require any additional control technique.
The rest of this paper is organized as follows. In section 2, A brief introduction to feedback linearization is provided. In section 3, modeling of the kinematics of a spherical mobile robot is presented. In section 4 introduces the proposed method solving the under-actuated problem of the spherical mobile robot. In section 5, simulation is performed to verify the performance of the designed controller. Finally, conclusions are drawn in section 6.

2. Preliminaries

This section describes the feedback linearization introduced in [21]. Feedback linearization is a common approach used to control nonlinear systems. The main idea of this approach is to algebraically transform the nonlinear system dynamics into a fully or partially linearized system so that the feedback control techniques could be applied. It is different from linear approximation using Taylor series or Jacobian matrix for linear control because the stability of the whole system is guaranteed by accurate state transformation and feedback.
The idea of feedback linearization, i.e., of canceling the nonlinearities and imposing a desired linear dynamics, can be simply applied to a class of nonlinear systems described by the so-called companion form, or controllability canonical form. A system is said to be in companion form if its dynamics is represented by
x ( n ) = f ( x ) + b ( x ) u
where u is the scalar control input, x is the scalar output of interest, x = [ x , x ˙ , , x ( n 1 ) ] T is the state vector, and f ( x ) and b ( x ) are nonlinear functions of the states. This form is unique in the fact that, although derivatives of x appear in this equation, no derivative of the input u.
Note that, in state-space representation, (1) can be written as
d d t x 1 x n 1 x n = x 2 x n f ( x ) + b ( x ) u
Using the control input (assuming b to be non-zero)
u 1 b [ v f ]
We can cancel the nonlinearities and obtain the simple input-output relation (multiple integrator form)
x ( n ) = v
Thus, the control law
v = k 0 x k 1 x ˙ k n 1 x ( n 1 )
with the k i chosen so that the polynomial p n + k n 1 p n 1 + + k 0 has all its roots strictly in the left-half complex plane, leads to the exponentially stable dynamics
x n + k n 1 x n 1 + + k 0 x = 0
which implies that x ( t ) 0 . For tasks involving the tracking of a desired output x d ( t ) , the control law
v = x d ( n ) k 0 e k 1 e ˙ k n 1 e ( n 1 )
(where e ( t ) = x ( t ) x d ( t ) is the tracking error) leads to exponential convergence of tracking errors. Note that similar results would be obtained if the scalar x was replaced by a vector and the scalar b by an invertible square matrix.

3. Description of spherical mobile robot

A single pendulum spherical mobile robot with two degrees of freedom pendulum is introduced as Figure 1 shows. A shaft is placed in a straight line at the center of the spherical shell and a pendulum is installed at the center of the shaft. Motor 1 rotates the pendulum along the horizontal axis of the shaft and controls the steering of the spherical mobile robot by its rotation. Motor 2 rotates the shaft around the vertical axis and controls the driving of the spherical mobile robot.

3.1. Kinematic model

The Figure 2 shows the rotation of spherical, where θ , φ and ψ indicate roll-pitch-yaw angles of the spherical mobile robot. O X Y Z represents the reference frame {A} and O 1 X 1 Y 1 Z 1 is a body frame {B} which can rotate by angle ψ about Z axis. As ψ rotates, O 2 X 2 Y 2 Z 2 , a frame {C} is generated. In order to derive the kinematic model, two rotation matrices should be obtained; between a frame {A} and a frame {B}, and between a frame {B} and a frame {C}. The rotation matrix between a frame {A} and a frame {B} is represented as follows:
R 1 = R z , ψ = cos ( ψ ) sin ( ψ ) 0 sin ( ψ ) cos ( ψ ) 0 0 0 1
i 1 j 1 k 1 = R 1 i j k = cos ( ψ ) i + sin ( ψ ) j sin ( ψ ) i + cos ( ψ ) j k
The rotation matrix between a frame {A} and a frame {B} is described as
R 2 = R y 1 , φ = cos ( φ ) 0 sin ( φ ) 0 1 0 sin ( φ ) 0 cos ( φ )
i 2 j 2 k 2 = R 2 i j k = cos ( φ ) i 1 sin ( φ ) k 1 j 1 sin ( φ ) i 1 + cos ( φ ) k 1
The angular velocity of the spherical mobile robot is written as follows:
ω = ψ ˙ k θ ˙ i 2 + φ ˙ k 1 = ψ ˙ k 1 θ ˙ ( cos ( φ ) i 1 sin ( φ ) k 1 ) + ω ˙ j 1 = θ ˙ cos ( φ ) i 1 + φ ˙ j 1 + ψ ˙ + θ ˙ sin ( φ ) k 1
According to the relative velocity formula, the following equation is given
V G = V C + V r f l + ω s × r G / C
where V G is the velocity of the spherical mobile robot, V C represents its contact point velocity with the ground surface and V r f l shows the relative velocity of flexible links. r G / C represents the position of the spherical center with respect to ground.
r G / C = R k = R k 1
where R is the radius of the sphere.
We assume that the spherical robot rotates without slipping. Therefore, V C = V r e f = 0 and the equation (9) can be written in the following form:
V G = ω s × r G / C = ρ φ ˙ i 1 + ρ θ ˙ cos ( φ ) j 1 +
Through the coordinate transformation, the velocity of the spherical mobile robot in frame {A} is as follows:
V G = X ˙ i + Y ˙ j = R φ ˙ cos ( ψ ) R θ ˙ cos ( φ ) sin ( ψ ) i + R φ ˙ sin ( ψ ) + R θ ˙ cos ( φ ) cos ( ψ ) j
where
X ˙ = R φ ˙ cos ( ψ ) R θ ˙ cos ( φ ) sin ( ψ ) Y ˙ = R φ ˙ sin ( ψ ) + R θ ˙ cos ( φ ) cos ( ψ )
because there is not any actuator around the vertical axis and as it is mentioned the robot rotates without slip so the angular velocity can be derived by the following equation.
ψ ˙ + θ ˙ sin ( φ ) = 0
Based on equations (13), (14), the kinematic model of the spherical mobile robot is derived as
X ˙ = R φ ˙ cos ( ψ ) R θ ˙ cos ( φ ) sin ( ψ ) Y ˙ = R φ ˙ sin ( ψ ) + R θ ˙ cos ( φ ) cos ( ψ ) ψ ˙ = θ ˙ sin ( φ )
Define U 1 = φ ˙ and U 2 = θ ˙ cos ( φ ) . Then equation (15) can be rewritten as
X ˙ = R cos ( ψ ) U 1 R sin ( ψ ) U 2 Y ˙ = R sin ( ψ ) U 1 + R cos ( ψ ) U 2 ψ ˙ = tan ( φ ) U 2
As equation (16) represents, the spherical mobile robot is an under actuated system. In the next section, the control technique is introduced to solve the under-actuated problem.

4. The design of controller

4.1. Controller Design

To solve the under-actuated problem, we propose the controller design method using virtual reference input.
As Figure 3 shows, the block diagram of proposed closed-loop control system. There is no direct way to control the heading direction angle, ψ in the given system. In tracking control problem, a reference input is provided in general. With this point of view, we generate reference inputs especially for ψ and using the error dynamics derive a virtual control input for ψ .
The error is defined as follows:
X e Y e ψ e = cos ( ψ ) sin ( ψ ) 0 sin ( ψ ) cos ( ψ ) 0 0 0 1 X X r Y Y r ψ ψ r
where X r , Y r , ψ r are the reference input values for each state.
Remark 1. 
Remark The definition (17) provides decoupled inputs for each state in error dynamics. In general, an error varibles are directly defined with the state variables of systems. However, it occurs the input coupling problem in the kinematic model of spherical mobile robot. In order to solve the problem, some refine technique is required such as the coordinate transformation in (17). Through (17), input U 1 controls state X and input U 2 controls state Y as a result.
Differentiating the equation (17) yields
X ˙ e = ψ ˙ Y e R U 1 + R φ ˙ r cos ( ψ e ) + R θ ˙ r sin ( ψ e ) cos ( φ r )
Y ˙ e = ψ ˙ X e R U 2 + R φ ˙ r sin ( ψ e ) + R θ ˙ r cos ( ψ e ) cos ( φ r )
ψ ˙ e = ψ ˙ r tan ( φ ) U 2
where virtual reference input is defined as ψ ˙ r . X and Y can be directly controlled through the two inputs of equations (18) and (19) but ψ in equation (20) can‘t be controlled so it is solved through a virtual reference
Remark 2. 
In order to achieve path tracking of the under-actuated spherical mobile robot, an alternative input that can work as a controller is required because it must be controlled down to ψ without an input. Therefore, the virtual reference input can be arbitrarily designed like the reference input of a typical system, so it works as a control input. since it can work as another controller, it can be designed according to the Lyapunov stability theory like the conventional controller design. As a result, it can fulfill the path tracking purpose of an under-actuated spherical mobile robot.
The following theorem is proposed for path tracking of a spherical mobile robot. The proposed theorem is verified through lyapunov stability analysis.
Theorem 1. 
If control gain K i ( i = 1 , 2 , 3 ) is properly designed for control input equation (21), (22) and virtual reference input equation (23) and applied to equations (18), (19), (20) it can be lim t E ( t ) = 0 and ensure the tracking performance of the proposed spherical mobile robot.
U 1 = 1 R ( K 1 X e + R 2 φ ˙ r cos ( ψ e ) R 2 θ ˙ r sin ( ψ e ) cos ( φ r ) )
U 2 = 1 R ( K 1 X e + R 2 φ ˙ r cos ( ψ e ) R 2 θ ˙ r sin ( ψ e ) cos ( φ r ) )
ψ ˙ r = K 3 ψ e + tan ( φ ) U 2
where K i ( i = 1 , 2 , 3 ) is positive real.
Proof. 
Consider the following Lyapunov function for stability analysis.
V = 1 2 X e 2 + Y e 2 + ψ e 2
The equation (24) is differentiated as follows
V ˙ = X e ( Y e ψ ˙ R φ ˙ + R φ ˙ r cos ( ψ e ) R θ ˙ r sin ( ψ e ) cos ( φ r ) ) + Y e ( X e ψ ˙ + R θ ˙ cos ( φ ) + R φ ˙ r sin ( ψ e ) + R θ ˙ r cos ( ψ e ) cos ( φ r ) ) + ψ e ( ψ ˙ r θ ˙ sin ( φ ) )
Substituting equations (21), (22), (23) into equation (25) it is presented as follows
V ˙ = K 1 X e 2 K 2 Y e 2 K 3 ψ e 2
It satisfies V ˙ < 0 to ensure asymptotic stable, since K i ( i = 1 , 2 , 3 ) is positive real □

5. Simulation

In this section, in order to verify the performance of the proposed method, a path tracking of the spherical mobile robot is considered and its simulation result is provided.
The reference path is X r = 5 cos ( π / 20 ) and Y r = 4 sin ( π / 20 ) the initial condition of the spherical mobile robot is X 0 , Y 0 , ψ 0 , θ 0 = [ 0 , 0 , 0 , 0 ] .
For the simulation, the parameters of the spherical mobile robots are given in Table 1.
Figure 4 shows the path tracking control result in the X Y plane, As times goes, the spherical mobile robot departs the initial position and follows to the reference path within 0.5 seconds. Figure 5 and Figure 6 describe the error between the reference input X r and the state X, and the error between the reference input Y r and the state Y. As figures indicate, errors converge to zero. Figure 7 and Figure 8 describe the settling time of the error between the reference input X r and the state X, and the error between the reference input Y r and the state Y. The performance of the proposed control system can be verified by quickly converging the settling time of the two errors to within 0.5 seconds.

6. Conclusion

In this paer, the virtual reference input based single loop controller is proposed for the spherical mobile robot to solve its under actuated problem in the kinematic model. The virtual reference input works as a control input since it can be arbitrarily designed just like the reference input of a conventional system. It is derived by Lyapunov Stability Theory, it guaranteed the stability of the closed loop system. The proposed scheme achieved the stabilization and path following control of the under actuated spherical mobile robot without any additional control technique and the simulation results validated its performance.

References

  1. Michaud, F.; Caron, S. Roball, the rolling robot. Autonomous robots. 2002, 12(2), 211–222. [Google Scholar] [CrossRef]
  2. Bicchi, A.; Balluchi, A.; Prattichizzo, D.; Gorelli, A. Introducing the "sphericle": an experimental tested for research and teaching in nonholonomy. Proceedings of International Conference on Robotics and Automation. 1997, 3, 2620–2625. [Google Scholar]
  3. Armour, R. H.; Vincent, J. F. Roball, Rolling in nature and robotics: A review. Journal of Bionic Engineering. 2006, 3(4), 195–208. [Google Scholar] [CrossRef]
  4. Li, Z.; Canny, J. Motion of two rigid bodies with rolling constraint. IEEE Transactions on Robotics and Automation 1990, 6(1), 195–208. [Google Scholar] [CrossRef]
  5. Crossley, V. A. A literature review on the design of spherical rolling robots. Pittsburgh, Pa. 2006; 1–6. [Google Scholar]
  6. Cai, Y. , Zhan, Q.; Xi, X. Path tracking control of a spherical mobile robot. Mechanism and Machine Theory. 2012, 51, 58–73. [Google Scholar] [CrossRef]
  7. Zhao, B.; Li, M.; Yu, H.; Hu, H.; Sun, L. Dynamics and motion control of a two pendulums driven spherical robot. In 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2010; 147–153. [Google Scholar]
  8. DeJong, B. P.; Karadogan, E.; Yelamarthi, K.; Hasbany, J. Design and analysis of a four-pendulum omnidirectional spherical robot. Journal of Intelligent & Robotic Systems. 2017, 86, 3–15. [Google Scholar]
  9. Zhan, Q.; Cai, Y.; Yan, C. Design, analysis and experiments of an omni-directional spherical robot. In 2011 IEEE International Conference on Robotics and Automation. 2011, 4921–4926. [Google Scholar]
  10. Firlej, S. Roball, Design, construction and control of a spherical rolling robot with internal two-wheel cart. Automatyka/Automatics. 2015, 19(2), 63. [Google Scholar] [CrossRef]
  11. Mojabi, P. Introducing August: a novel strategy for an omnidirectional spherical rolling robot. In Proceedings 2002 IEEE International Conference on Robotics and Automation. 2002, 4, 3527–3533. [Google Scholar]
  12. Karavaev, Y. L.; Kilin, A. A. The dynamics and control of a spherical robot with an internal omniwheel platform. Regular and Chaotic Dynamics. 2015, 20, 134–152. [Google Scholar] [CrossRef]
  13. Qiang, Z.; Zengbo, L.; Yao, C. A back-stepping based trajectory tracking controller for a non-chained nonholonomic spherical robot. Chinese Journal of Aeronautics. 2008, 21(5), 472–480. [Google Scholar] [CrossRef]
  14. Yue, M.; Liu, B.; Wei, X.; Hu, P. Adaptive sliding-mode control of spherical robot with estimated rolling resistance. Cybernetics and Systems. 2014, 45(5), 407–417. [Google Scholar] [CrossRef]
  15. Kayacan, E.; Bayraktaroglu, Z. Y.; Saeys, W. Modeling and control of a spherical rolling robot: a decoupled dynamics approach. Robotica. 2015, 30(4), 671–680. [Google Scholar] [CrossRef]
  16. Taheri Andani, M.; Ramezani, Z.; Moazami, S.; Cao, J.; Arefi, M. M.; Zargarzadeh, H. Observer-Based sliding mode control for path tracking of a spherical robot. Complexity. 2018. [Google Scholar] [CrossRef]
  17. Reyhanoglu, M.; van der Schaft, A.; McClamroch, N. H.; Kolmanovsky, I. Dynamics and control of a class of underactuated mechanical systems. IEEE Transactions on automatic control. 1999, 44(9), 1663–1671. [Google Scholar] [CrossRef]
  18. Qian, D.; Yi, J.; Zhao, D. Hierarchical sliding mode control for a class of SIMO under-actuated systems. Control and cybernetics 2008, 37(1), 159–175. [Google Scholar]
  19. Bao-Li, M. Comments on" Structure design of two types of sliding-mode controllers for a class of under-actuated mechanical systems". arXiv preprint arXiv:1208.6144. 2012.
  20. Park, K. B. Comments on’design of a stable sliding-mode controller for a class of second-order underactuated systems’. IET control theory & applications. 2012, 8(6), 1153. [Google Scholar]
  21. Slotine, J. J. E.; Li, W. Applied nonlinear control. Prentice Hall 1991. [Google Scholar]
Figure 1. Structure of Spherical mobile robot
Figure 1. Structure of Spherical mobile robot
Preprints 80050 g001
Figure 2. The rotation of Spherical mobile robot
Figure 2. The rotation of Spherical mobile robot
Preprints 80050 g002
Figure 3. The Block Diagram of Spherical mobile robot
Figure 3. The Block Diagram of Spherical mobile robot
Preprints 80050 g003
Figure 4. Path Tracking in the X Y Plane
Figure 4. Path Tracking in the X Y Plane
Preprints 80050 g004
Figure 5. The Error Between X r and X
Figure 5. The Error Between X r and X
Preprints 80050 g005
Figure 6. The Error Between Y r and Y
Figure 6. The Error Between Y r and Y
Preprints 80050 g006
Figure 7. Settling Time of The Error Between X r and X
Figure 7. Settling Time of The Error Between X r and X
Preprints 80050 g007
Figure 8. Settling Time of The Error Between Y r and Y
Figure 8. Settling Time of The Error Between Y r and Y
Preprints 80050 g008
Table 1. The values of parameters used for simulation.
Table 1. The values of parameters used for simulation.
Parameters Values
Radius of Spherical R 0.3 mm
Control Gain K i ( i = 1 , 2 , 3 ) 30, 30, 10
Reference Roll Angle θ r π / 2
Reference Pitch Angle ψ r π / 4
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.
Copyright: This open access article is published under a Creative Commons CC BY 4.0 license, which permit the free download, distribution, and reuse, provided that the author and preprint are cited in any reuse.
Prerpints.org logo

Preprints.org is a free preprint server supported by MDPI in Basel, Switzerland.

Subscribe

© 2024 MDPI (Basel, Switzerland) unless otherwise stated