Open access peer-reviewed chapter

WMR Kinematic Control Using Underactuated Mechanisms for Goal Direction and Evasion

By Jorge U. Reyes-Muñoz, Edgar A. Martínez-García, Ricardo Rodríguez-Jorge and Rafael Torres-Córdoba

Submitted: April 19th 2017Reviewed: September 4th 2017Published: December 20th 2017

DOI: 10.5772/intechopen.70811

Downloaded: 601

Abstract

This work presents the mechanical design and the kinematic navigation control system for a tricycle-wheeled robot (one drive-steer and two lateral fixed passive) with two underactuated mechanisms: a global compass and local evasive compass. The proposed goal-reference mechanism is inspired by the ancient Chinese south-seeking chariot (c. 200–265 CE) used as a navigation compass. The passive lateral wheels transmit an absolute angle from its differential speeds to automatically steer the front wheel. An obstacle-evasive compass mechanism is commutated for steering control when detecting nearby obstacles. The absolute and local compass mechanisms commutate each other to control to the robot’s steering wheel to reach a goal while avoiding collisions. A kinematic control law is described in terms of the robot’s geometric constraints and is combined with a set of first-order partial derivatives that allows interaction between the global and local steering mechanisms. Animated simulations and numerical computations about the robot’s mechanisms and trajectories in multi-obstacle scenarios validate the proposed kinematic control system and its feasibility.

Keywords

  • WMR
  • kinematic control
  • south-seeking chariot
  • underactuated compass
  • potential-field
  • self-steer
  • navigation

1. Introduction

So far today, numerous types of modern robotic platforms that perform complex tasks are composed of underactuated mechanisms that were deployed by ancient civilizations. Underactuated mechanisms prevail as the most efficient systems because they take more advantage applying the law of conservation of energy than redundantly kinematic systems. Unlike redundant systems, the underactuated systems pose a reduced number of actuators and less independent control variables and naturally take more advantage of the inertial and gravity forces. The redundant systems have a larger number of control variables than variables in the working space. As a consequence, each controlled actuator somehow has to counteract gravity and inertial forces to establish own kinematic behaviors. A major aspect in robotics engineering concerns physical modeling and control of mobility for a robot to provide autonomous navigation. Similar to any biological entity, the ability to purposely navigate is fundamental for an intelligent robot. Over 2000 years ago, the Chinese invented the south-seeking chariot (SSC), which was used to maintain an absolute orientation along very long trips of hundreds of kilometers. Thus, they basically created one of the first absolute direction compass devices that did not require any other element to function, but its inner mechanisms only. The invention’s compass was used to adjust toward a desired orientation at the beginning of a trip, and it was invented nearly 800 years in advance when the magnetic compass was invented. The SSC is basically a differential gearing system with a pointing-out silhouette above (Figure 1). The gearing system compensates the chariot turns by gear transmission relations, keeping the statue arm pointing out always to the same direction. Figure 1a shows the SSC design, and Figure 1b depicts the SSC prototype with its gearing system made of straight wooden gears. However, this system has largely been studied in modern times by numerous authors [17].

Figure 1.

South-pointing chariot. (a) Modern design and (b) modern prototype.

Any type of navigational and path-tracking task depends on steering systems. And, in order to infer navigation references, mobile robots use a diversity of exteroceptive sensing devices, such as ultrasound sonar, infrared range detectors, cameras, GPS, and so forth. Nevertheless, a common disadvantage using these types of devices is that they have to obtain external measurements with respect to (w.r.t.) the robot’s fixed Cartesian coordinate system and use them to estimate orientation through geometry models with cumulative errors.

Moreover, some types of proprioceptive sensing devices offer inner measurements that are relative to global inertial system (e.g., magnetic compass, GPS). Unlike local exteroceptive sensors, global proprioceptive sensors yield noncumulative overtime measurement errors. For instance, a magnetic compass implemented as a global orientation system measures angle w.r.t. the earth magnetic axis. And then, such measurement angle is arithmetically used to infer a global destination angle likely described in another external inertial system. However, magnetic compasses are sensitive and are affected by other nearby magnetic fields or tided to suffer errors from rotations that set the device perpendicular to the earth’s magnetic axis. Therefore, other types of sensing devices must be combined to recover from missed observations. Furthermore, the global positioning system (GPS) is another type of global orientation measurement device, which requires at least two successive position observations overtime to provide an instantaneous robot’s global angle w.r.t. the earth’s geographic north pole. As a major disadvantage, GPS cannot provide measurements nearly of inside buildings, forests, or in cloudy days because electromagnetic signals are blocked missing observations during arbitrary periods of time.

A diversity of works has reported navigation systems that combine numerous types of measuring orientation devices such as GPS and magnetic compasses, which provide high precision. This type of technology produces sensing measurements tided to established references (e.g., magnetic/north pole). Hence, useful global-specific references have to be inferred by different methods, which may imply in these calculations inverse/direct solutions of geometric triangulations or algebraic models [812].

Reliable local/global navigation for a wheeled mobile robot has fundamentals on controllability and maneuverability. And, both robot’s abilities, respectively, must depend on robust driving control models and the steering kinematic designs [13, 14]. These models are the bases for planning and motion control [15, 16] in navigation, and most of them relay on different numerical mathematical solutions in robotics [17]. There are some complex works on robot’s navigation seeking absolute orientation references [19, 20]. There are other navigation works with major emphasis on collision avoidance relaying on kinematic approaches [18, 21].

In this work, the mechanical design, the physical model, and a control system for a tricycle-wheeled robot with fundamentals on underactuated mechanical functions are proposed. The self-steer robot design proposed in this work has been inspired on the south-seeking chariot, in part, to take advantage of the underactuated mechanical compass with absolute direction to the robot’s goal. Therefore, a specific and complex gearing mechanism system was designed to self-steer commuting between an obstacle-avoiding compass and a leading-to-the-goal compass (Figure 2). The global goal-reference compass permanently maintains orientation information available in a direct manner for the robot without sensors, despite experimenting multiple evasive maneuvers.

Figure 2.

Proposed tricycle robot system. (a) General system view and (b) absolute/local compass mechanism.

A kinematic model for the local/global compass and commutation mechanisms are deduced. Moreover, a kinematic control law deduced for a three-wheeled structure with one drive-steer frontal wheel and a pair of lateral passive wheels is analyzed and disclosed. The proposed control law estimates the robot’s posture and combines the interactive switching between goal-leading and obstacle avoidance navigation control. One underactuated mechanism directly leads the robot to the goal. Another underactuated mechanism leads the robot toward free-collision routes.

This manuscript presents simulation results to validate this novel approach that combines ancient underactuated automaton type, with a modern-wheeled robot focus. So far today, the authors are not conscious about other similar approaches reported in the scientific literature. This work does not pretend to introduce a comparative analysis nor efficiency with other state-of-the-art robotic trends. The authors of this research believe that the preliminary results presented in this manuscript will evolve into an efficient technological approach in the near future. Its application will establish a novel approach because it allows to directly have absolute angle observation overtime, allowing the mechanisms to lead the robot with naturally global navigation, reducing computational efforts to other algorithmic tasks, and complementing other sensing devices to improve control and perception.

Sections of this chapter have been organized in the following manner. Chapter 2 discloses the kinematic models for the absolute/local mechanisms. In Chapter 3, the commutation system kinematic and time delays are discussed. In Chapter 4, the control model and simulation results are presented. Finally, Chapter 5 discusses some conclusive remarks about this work.

2. Absolute/local compass mechanism

2.1. Global underactuated compass

The proposed system sets the robot’s desired Cartesian goal as the absolute reference orientation. The absolute compass directly compensates its bearing by the differential angle provided by the two lateral wheels (Figure 3a). The mechanical compass directly self-steer the robot toward the global reference without any actuator (Figure 3b). When the robot is not leading along the global compass angle, the synchronization chain gradually reorientates the robot’s steering wheel until matching the goal’s absolute angle. Figure 3c illustrates the self-steering mechanism parts: (1) passive lateral wheels, (2) frontal driving wheel with passive steering, (3) wheel differential gearing mechanisms, (4) transmission gears coupling the absolute compass, (5) global goal-angle compass, (6) driving actuator/motor, (7) self-steer synchronization chain, and (8) lateral wheel shaft.

Figure 3.

Absolute compass system. (a) Wheel differential mechanisms, (b) self-steer mechanism, and (c) goal-reference self-steer robot mechanism.

In Figure 4, a more detailed depiction of the differential mechanism is illustrated. The absolute compass (5) is composed of three differential systems (3) and (5), which transmit rotary motion from the lateral wheels (1) up to the steering wheel (2) (see Figure 4b). The compass (5) is compensated by the gearing relations (Figure 4b), and the differential rotary motion is transmitted to the gear (5), namely, eabs. It is worth noting that the differential motion (3) of the lateral wheels’ shaft (8) is fixed to the main axis (4). The lateral wheels’ angular speeds, dubbed w1 and w2, are asynchronous w.r.t. the main shaft (4), similarly differential gears e1 and e2. The differential shafts of gears dif1 and dif2 (Figure 4b) are perpendicularly joined to the main axis (Figure 4a), and the rotary speed is basically the same for both differentials (4). Nevertheless, the angular velocity for gears (dif11, dif12, dif21, and dif22) might be different for each differential mechanism (3); it would depend on each wheel’s (1) instantaneous velocity.

Figure 4.

Differential gearing system. a) wheel main shafts, b) absolute direction differential.

Finally, the compass, differential mechanism (5) that is composed of the gears e1, e2, and eabs is the mechanism providing the absolute orientation reference toward the robot’s goal.

Without loss of generality, it follows that the deduction of the differential angular velocity model transmitted between e1 and e2 is provided next. Thus, the angular velocity for ωe1 is an averaged differential value:

ωe1=ω1ω22E1

where both lateral angular speeds have clockwise (left-sided wheel) and counterclockwise (right-sided wheel) signs, respectively:

ωe1=ωe2E2

The differential angular speed is equivalent to the main shaft rotary speed, such that

ωdif1=ωdif2=ω1ω22E3

and, in general, it is assumed that the gears’ (dif1 and dif2) angular velocities are averaged values:

ωdif11=ωdif12=ω1+ωe12E4

as well as

ωdif21=ωdif22=ω2+ωe22.E5

In such a manner, the angular velocity transmitted to the compass e_abs poses the following relation:

ωeabs=reabsre1ωe1,E6

In the proposed design, it is assumed that the gear e_abs doubles its radius w.r.t. gears e1 and e2. Therefore, by rewriting Eq. (6)

ωeabs=12ωe1,E7

and by substituting in the previous expression, the differential rotary speed model ωe1 since ultimately depends on velocities ω1 and ω2:

ωeabs=ω1ω24.E8

Therefore, from the previous expression, let us assume that the robot moves along a straight trajectory line, then ω1 = ω2, and no compass lateral motion is yielded; hence, ωeabs = 0. Following Figure 2b notation for the gears, the steering wheel with gear E7 is synchronized with ωeabs by the mechanism system illustrated in Figure 5a.

Figure 5.

Steering mechanisms. (a) Goal-direction system and (b) evasive compass gearing.

A first gear connection E0 − E1 has the following speed relation:

ϕ̇1=r0r1ϕ̇0;E9

Similarly, the gear connection E1 − E2 is algebraically simplified:

ϕ̇2=r1r2ϕ̇1=r0r2ϕ̇0;E10

The parallel connection E5 with E2 has the same relation:

ϕ̇5=ϕ̇2=r0r2ϕ̇0;E11

Finally, the angular velocity for E7 w.r.t. E0

ϕ̇7=r5r7ϕ̇5=r0r5r2r7ϕ̇0.E12

Thus, the relation (12) means that E7 poses opposite rotary movement w.r.t. the absolute compass sense of rotation and half of its angular speed as well.

2.2. Local evasive compass

Another compass mechanism with local reference frame steers the robot for obstacle avoidance leading the robot along a safe instantaneous angle (Figure 5b). When the robot detects near obstacles, the absolute compass is suspended, and a commutator device switches to the evasive local compass mechanism, activating the gear E8. Figure 5b describes the gearing mechanism that steers the robot for evasive navigation.

In the kinematic model for evasive steering through E7, w.r.t. E8 is deduced next. The relation between E8 and E6 is

ϕ̇6=r8r6ϕ̇8;E13

and the angular velocity for E4 is

ϕ̇4=r6r4ϕ̇6=r8r4ϕ̇8,E14

For the perpendicular connection with E3, the angular speed model is

ϕ̇3=r4r3ϕ̇4=r8r3ϕ̇8;E15

For E3 and E5 connected in parallel

ϕ̇5=ϕ̇3=r8r3ϕ̇8;E16

Finally, the model for E7 is

ϕ̇7=r5r7ϕ̇5=r8r5r2r7ϕ̇8.E17

Let us highlight that for the evasive local compass E8, the escaping orientation is instantaneously set up by an actuator only when any nearby obstacle is detected. And, such local orientation transmits motion to the steering gear (E7) through the mechanism of Figure 5b. Thus, the local/global compass mechanisms are physical controllers that substitute models and computer algorithms.

3. Absolute/local commuting mechanism

The commutation mechanism interactively couples and uncouples either the absolute compass or the local compass (Figure 6a). The commuting device switches into the local compass immediately where any nearby obstacle is detected. Alternatively, it switches to the global compass retaking orientation toward the goal as soon as obstacles are no longer detected. Figure 7a depicts the gearing transmission that commutates the different steering mechanisms, the local compass (the front), and the global compass (the back).

Figure 6.

Commutator device. (a) Absolute/evasive motion transmission system and (b) basic commuter mechanism.

Figure 7.

Motion transmission flow (red arrowed lines). (a) Goal-reference and (b) obstacle evasive.

According to Figure 6b, the commutation mechanism yields linear motion (the commutator device of Figure 6a); it activates the local compass by rotating a servomotor and shrinking a sliding crank link L. Inversely, the absolute compass is activated by turning off the servomotor, and then a spring-mass-damper system stretches the sliding crank link L.

The motion transmission system (Figure 6a) is inspired by the model of a modern vehicle’s speed transmission box. For the present case, a common shaft works for two asynchronous speed gearing systems. In addition, Figure 7a and 7b illustrates the motion transmission flow by the red color arrowed lines. When either the local compass mechanism or the global compass mechanism is commutated, the flow transmission motion only concerns with its own gearing mechanism featuring a physical continuous controller.

The angular speed model ωl [s−1] for the commutation rotary servomotor (Figure 6b) to switch into the local compass was obtained through fitting empirical observations with the next theoretical model:

ωl=κ1eκ2t;E18

where κ1 [rad/s] is an amplitude factor and κ2 [1/s] is a slope rate factor. Subsequently, to estimate the commutation time tl [s] required to mechanically coupling into the local compass mechanisms, the next model is deduced:

tl=lnωlκ2κ1.E19

Moreover, when no obstacles are detected, the commuter device switches into its initial state by coupling the absolute compass. In this case, an underactuated system commutates the state by a spring-mass-damper mechanical system with critically dumped configuration, modeled by second-order linear differential equation. Where m [kg] is the mass pulling the spring, c [kg/s] is the damping effect constant, k [kg/s 2] is the spring elasticity constant, and x, ẋ, and x¨are the spring distance, velocity, and acceleration, respectively:

mx¨+cẋ+kx=0E20

Thus, it may be solved as a first-order linear equation by temporally omitting the second-order term mx¨such that

cdxdt=kx,E21

reorganizing and completing the integrals

xdxx=kctdt,E22

Thus, by solving the improper integrals and multiplying both sides of the equation by the Euler number e,

elnx=kct+C1E23

and a solution is obtained; to simplify let us define λ ≔  − k/c,

xt=eλt+c1E24

Assuming the integration constant C1 = 0 and developing the higher order solutions

xt=eλt;ẋt=λeλt;x¨t=λ2eλt.E25

In addition, by substituting such functions in the next expression

mλ2eλt+eλt+keλt=0,E26

In order to decrease the commutation time of the sliding linear mechanism, a critically damped system is assumed and modeled by (c2 − 4mk) = 0, with terms λ1 = λ2:

λ1,2=c2m,E27

It is desired to speed up as much as possible the commutation time. Then, the mechanical device linear displacement is modeled as a function of time by

xt=a1+a2ect/2m.E28

And, solving for the commutation time for switching to the absolute compass ta,

ta=2mclnxa1+a2E29

Figure 8 depicts a sequence of transition times taken by the commuting mechanism. Times tl are the times behavior of the slider crank servomotor when shrinking the link. Times ta are the times behavior of the spring-mass-damper device when stretching the link. Such time magnitudes are reached due to mechanical motions. However, such commutation times are physically fast enough, and a robot’s trajectory is not affected in the precise points when commutations occur.

Figure 8.

Commuting times: ta (absolute mechanism) and tl (local mechanism).

4. Kinematic control law

In this section, a kinematic control law is deduced and analyzed. The proposed controller simultaneously controls driving and self-steering velocities and keeps track of the robot’s posture. The robotic platform is a tricycle-type kinematic structure with two lateral passive wheels at the back (Figure 9a) and a central active-drive and passive self-steering wheel at the front (Figure 9b). Each wheel kinematic is described by three parameters, α, , and r, where α [rad] is the angle of a wheel w.r.t. the x-axis of the robot’s fixed inertial system, [m] is the distance between the robot’s centroid and each wheel’s contact point with the ground, and r [m] is an ideal wheel’s radius. In addition, the robot’s kinematic structure considers two controlled kinematic variables βt and ϕt, where βt [rad] is the instantaneous steering angle of the front-sided wheel and ϕ [rad] is the instantaneous driving wheel’s angle.

Figure 9.

Robot’s kinematic structure. (a) Top-view kinematic structure and (b) side-view drive-steer wheel.

The kinematic parameters and variables describing the robot platform are summarized in Table 1 according to each type of wheel (fixed passive, steerable, and drivable active).

Wheel typeαβt
W1 (fixed)00
W2 (fixed)π0
W3 (drive/steer)π/23

Table 1.

Tricycle-type robot’s wheel kinematic parameters and variables.

The robot’s wheel kinematic parameter is modeled by the following constraint equation, which is stated from the wheel plane,

J1βtRθtξ̇t+J2ϕt=0,E30

Likewise, the kinematic constraint is modeled in the wheel’s orthogonal plane by

C1βTRθtξ̇t=0.E31

where J1, C1 ∈ RN × 3 basically describes the wheel kinematic constraints. Matrix J2 poses the ideal wheel’s radius, and R(θ) is the Euler rotation matrix. Vector ξt describes the state space system, and its components are the robot’s posture ξ = (x, y, θ, β)Τ, as well as the front-sided wheel driving speed ϕt, and its product with J2 establishes a diagonal matrix of the wheels’ tangential velocities.

Moreover, for the particular case of fixed wheels and central orientable wheels, the following kinematic constraints apply for individual wheels.

In the wheel’s plane

sinα+βtcosα+βtcosβt·Rθt·ξ̇t+rϕ̇t=0.E32

In the wheel’s orthogonal plane

cosα+βtsinα+βtsinβt·Rθtξ̇t=0.E33

where matrix J1 is the fixed passive back-sided wheels matrix of kinematic constraints, which is obtained by substituting the parameters of Table 1 in expression (32). Such that, Jf for the fixed wheels is

Jf=sin0cos0cos0sinπcosπcos0,E34

and by simplifying

Jf=0101.E35

Taking into account the kinematic constraints that are similar to the central orientable wheel, the vector model Jo is obtained:

Jo=sinπ2+βtcosπ2+βt3cosβtE36

For the front-sided central orientable wheel, since the angle βt is nonstationary, and in order to easy its algebraic solution the following trigonometric identities are substituted in (36) and obtain a simplified form for the vector Jo. Thus,

sina+b=sinacosb+cosasinb,

Likewise,

cosa+b=cosacosbsinasinb;

and the following row vector is produced:

Jo=cosβtsinβt3cosβt.E37

Therefore, for a tricycle-type robotic structure as in the present context, and with parameters of Table 1, the matrix J1 is consequently defined as

J1=JfJo=0101cosβtsinβt3cosβt,E38

where Jf represents the fixed wheel kinematic constraints and Jo represents the central orientable wheel constraints. The constraints denoted in the general form (31) implicate that vector Rθt·ξ̇tbelongs to the null space C1denoted by

C1βt=CfCβE39

being Cf and Cβ as vectors of the fixed and the central orientable wheel constraint, respectively, with notation

Rθt·ξ̇tNC1βt.E40

Hence, the robot’s posture first-order derivative ξ̇tor state vector is constrained into a distribution defined as

NC1β=spancolΣβ,E41

and the null space of any matrix A, written as a NA, is the set of all solutions of A · x = 0 and stated in set notation by

NA=xRxA·x=0.E42

Thus, for the particular case of Eq. (41), the null space is

NC1βt=xR3C1βtx=0.E43

A manner to solve for the null space matrix condition is to reduce it to the echelon form Ψ:

C1=100100sinβtcosβt3sinβt,E44

Thus, a vector x that satisfies Eq. (43) must be defined then:

100100sinβtcosβt3sinβt·x1x2x3=000.E45

The previous expression (45) is a set of linear systems and is rewritten as an augmented matrix [C1| 0]:

C10=10001000sinβcosβ3sinβ0.E46

The augmented matrix (46) is algebraically solved by reducing it to echelon form, starting by making zeros the first column, but one the first element:

Ψ=100000sinβtcosβt3sinβt,E47

Then, sum up Ψ1, iΨ3, 1 where Ψ3, 1 = sin(βt):

Ψ=1000000cosβt3sinβt.E48

Since the pivot element Ψ2, 2 = 0, rows 2 and 3 are exchanged:

Ψ=1000cosβt3sinβt000.E49

Now, Ψi, 2 = 0 except its pivot element Ψ2, 2, thus let us divide Ψ2, i/ cos(βt) to set to 1 such pivoting element:

Ψ=100013tanβt000.E50

Thus, by having Ψ in the reduced form, now the system is solved as the system (45):

100013tanβt000·x1x2x3=000.E51

Hence, rewriting such a solution in the matrix form

x=03tanβ1x3E52

Being the vector x of this null space of matrix C1, such that

NC1β=span03tanβ1x3;E53

For our application purpose, x3 = cos β, then the null space solution NC1βis

NC1β=span03sinβcosβ.E54

Therefore, Eq. (41) is rewritten because for each instant time t, a temporal variable vt exist .

ξ̇=RΤθtΣβtvt,E55

and

β̇t=wt.E56

where vt is the instantaneous robot’s absolute velocity and wt is instantaneous robot’s yaw rate. As a matter of fact Σ(βt) is the null space of the kinematic constraint matrix in the wheel’s orthogonal plane (Eq. (54)), defined by

Σβt=03sinβtcos(β).E57

This state control law is expressed in a more compact form:

żt=Bzut;E58

where

z=ξtβt;Bzt=RΤθtΣβt001;u=vw.E59

Thus, by substituting expression (57) in the model (58), the kinematic control law is rewritten:

ẋẏθ̇β̇=3sinθsinβ03cosθsinβ0cosβ001·vw.E60

The robot’s posture is essentially modeled by Eq. (60) and validates by the Cartesian trajectory depicted in Figure 10a. For this case, v was set at constant value overtime, and w gradually increased according to the range {0, …, π/4}. Then, the robot turns into its original angle and then continues straight.

Figure 10.

Control law (60) simulation results. (a) Trajectory control with v=cte and w ranging β = {0, …, π/4}, (b) wheel’s steer angle β behavior, and (c) robot’s angle θ behavior.

Figure 10b and 10c shows β and θ behaviors w.r.t. orientation error θE, when θE = 0 the robot is bearing toward the desired goal. Actually, β depicts how the steering wheel performs from its starting angle up to the final angle. Because of the absence of obstacles, the steering wheel’s angle experiences no commutation toward the local mechanism. However, the absolute compass controls the wheel from the beginning and gradually steers until orientation is aligned to the global destination. Its behavior along the navigation task is illustrated in plot 10b.

Moreover, in order to instantaneously estimate the deviation angle θE, let us define the global destination θG [rad]. And, such desired orientation is perturbed by escaping angle θR [rad] due to relative obstacle locations (Figure 11a). Likewise, θR is established every time the local compass mechanism is switched to. Obstacles are detected within a territorial radius dl, or ignored when the robot moves farther away from the scope dl (Figure 11b).

Figure 11.

Evasive system. (a) θR and θG kinematics and (b) evasive territorial scope and obstacle-repulsive acceleration vectors.

For instance, sensor 1 detects a far obstacle, and its repulsive acceleration influence is low. However, sensor 6 yields a greater repulsive acceleration influence since it is nearer to the robot’s location.

Thus, let us postulate:

θE=θRθGE61

From the control law, the state vector z is now estimated by directly using the instantaneous error angle θE:

żẋẏθEβ=Bz·uvw,E62

and by obtaining the inverse solution for u, now the input system involves error angle:

uvw=Bz1·żẋẏθRθGβ.E63

The robot’s controlled orientation is fed back by θE and calculated by numerical successive approximations. This controller is a recursive system that involves both, the direct and the inverse solutions, to reduce the numerical error θE.

The instantaneous escaping angle θR is obtained within a local coordinate system by directional derivatives, which approach a cosine function, similarly to the work reported in Ref. [20]. A gradient operator of a cosine navigation function approximates a repulsive partial differential equation to evade any observable obstacle. The robot’s repulsive acceleration vector function aα=axayproduces its magnitude effect w.r.t. the obstacle’s range measurement δα [m]:

aαxy=x,ykαk2rα·cosφαE64

where k2 [m] is the obstacle diametrical territory and [ms−2] is an adjustment constant factor of the physical acceleration amplitude. Thus, the Cartesian geometric model (not measurement) describes the distance between the robot xr = (xr, yr) and any obstacle xo = (xo, yo), which is geometrically modeled by

rα=x2+y2=xrxo2+yryo2E65

The angle limits {0 ≤ φα ≤ π/2} is a transformation relationship of the obstacle range δα, and the condition δα < dl limits the repulsive acceleration effects:

φα=δαπ2dl;wheredlπ2anddl=δαa=0E66

Substituting the functional form of δα in (64) and temporally considering  = 1 for analysis purpose

aαxy=x,yk2xrxo2+yryo2·cosφαE67

and algebraically expanding

aαxy=x,yk2cosφα+xrxo2+yryo2·cosφαE68

Thus, applying the gradient operator ∇x, y w.r.t. x and y components and algebraically simplifying

aαx=xrxo·cosφαxrxo2+yryo2E69

and

aαy=yryo·cosφαxrxo2+yryo2E70

Therefore, the obstacle-repulsive directional vector expressed in terms of Cartesian components XY is

aαxy=kαcosφαxrxo2+yryo2·xrxoyryoE71

Thus, the model for multiple obstacles α produces a controlled escaping direction in robot’s local coordinate framework:

aT=kααcosφαxrxo2+yryo2·xrxoyryoE72

It follows that the evasive acceleration magnitude is defined by

aT=aαx2+aαy22,E73

and the instantaneous escaping angle θR

θR=arctanayax.E74

Finally, the proposed kinematic controller has the following scheme described in Algorithm 1.

Algorithm 1. Local/global robot’s underactuated system controller

1 ωl = 0.0
2 while (∥ξt ∥  −  ∥ (xG, yG)∥) > 0 do
3  switching to either local or global mechanism
4  if δα > 0
5    Commuter’s motor speed ωl = k1ek2t
6    Servo’s angle φ=ωlκ1lnωlκ2
7    Avoidance acceleration aT=kααcosφαrα(̇xrxα)
8    Avoidance angle θR=arctana/ya/x
9    aT=a/x2+a/y22
10  else
11   Turns servo off ωl = 0.0
12    Release slider crank xa=rcosφa1+a22ect/mrsinφ22+Δs
13   θG=ϕw1ϕw24
14  θE = θR − θG
15  u=aTΔtdθEdtΤ
16  żt=BθEβ·ut
17  ut+1=B1·ż

Hereafter, Figure 12 validates our kinematic model approach by depicting how the robot’s trajectory reaches the final Cartesian goal (−7, −8) in global coordinates. In addition, Figure 12a shows the Cartesian trajectory among multiple obstacles and the local/global commuting steering modalities. Likewise, as a manner to show validation, Figure 12b illustrates only the component X versus the robot’s angle during the same navigational task.

Figure 12.

Controlled robot’s course v = 1.0 rad/s and dl = 0.5 m. (a) Cartesian space and (b) component X versus robot’s angle.

5. Conclusion

The interest of this chapter was to introduce the analysis of an alternative kinematic steering controller by using underactuated mechanical compasses and to demonstrate its feasibility, controllability approach, and natural efficiency. Despite the complexity in its implementation, a compass mechanism is proposed because it allows to directly set up the global goal as an absolute reference. Moreover, the compass mechanism itself directly steers the robot to the goal simultaneously avoiding obstacles. These functional features are important advantages for a robotic platform w.r.t. other traditional orientation systems, because the global orientation depends neither on feedback from sensor devices nor on computational complexity expenses to instantaneously estimate the global destination orientation. Unlike kinematic redundant structures, the proposed approach limits electric energy use for one driving actuator, not for steering actuators. Steering controllers no longer spend algorithmic computational resources, reserving such resources either for other robotic algorithmic tasks or for increasing additional hardware devices. Mechanical controllers are slow if compared with software algorithms, even though mechanisms are fast enough w.r.t. the available robot’s mobility speeds. In this regard, a critical issue is the commutation linear actuator, which is passive/active based on a slider crank combined with a spring-mass-damper system. The commutator device was fast enough, proving that sophisticated active linear actuators were not needed. It was found out that commutation times between local/global compasses did not negatively affect the system performance or the trajectory stability. Local/global compasses commuting activity warranted the robot to reach the global destination while avoiding collisions. The controlled trajectories yielded were concatenations of inter-switching segments with no discontinuities found. We concluded that from the implementation perspective, the proposed approach is neither necessarily better nor worst in effectiveness than a traditional redundantly actuated and multisensor approach. As a matter of fact, a traditional approach is easier to physically implement. Nevertheless, a redundant traditional approach is in disadvantage, if driving wheels grow in number, not to mention incrementing steering actuators. As a consequence, the more redundant is a system, the more discretized are the controlled motions and trajectories lose stability, which is an inherent difference from the naturally continuous motions produced by underactuated systems. A compact linear kinematic control law to switch inter-compass usage was deduced, with direct and inverse solutions. It elegantly combined the underactuated mechanism control with a very short algorithm to detect obstacles and to estimate the instantaneous escaping orientation. It was found that the robot’s trajectory continuity may be altered, if kinematic evasion parameters are readjusted consequently changing the mechanism commutation response. Through simulation results, the inter-mechanism interactions and functions were validated. For the specific case of the proposed kinematic structure, the local/global compass showed as much efficiency as any similar redundant system. The future work will focus on fault recovery from slips, sliding, or collision dynamics that get the compass orientation uncalibrated. In addition, not only to further orientation analysis but also positioning sensors to supplement and improve this underactuated approach.

© 2017 The Author(s). Licensee IntechOpen. This chapter is distributed under the terms of the Creative Commons Attribution 3.0 License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

How to cite and reference

Link to this chapter Copy to clipboard

Cite this chapter Copy to clipboard

Jorge U. Reyes-Muñoz, Edgar A. Martínez-García, Ricardo Rodríguez-Jorge and Rafael Torres-Córdoba (December 20th 2017). WMR Kinematic Control Using Underactuated Mechanisms for Goal Direction and Evasion, Kinematics, Efren Gorrostieta Hurtado, IntechOpen, DOI: 10.5772/intechopen.70811. Available from:

chapter statistics

601total chapter downloads

More statistics for editors and authors

Login to your personal dashboard for more detailed statistics on your publications.

Access personal reporting

Related Content

This Book

Next chapter

A New Methodology for Kinematic Parameter Identification in Laser Trackers

By Ana Cristina Majarena, Javier Conte, Jorge Santolaria and Raquel Acero

Related Book

First chapter

A Survey and Analysis of Cooperative Multi-Agent Robot Systems: Challenges and Directions

By Zool Hilmi Ismail and Nohaidda Sariff

We are IntechOpen, the world's leading publisher of Open Access books. Built by scientists, for scientists. Our readership spans scientists, professors, researchers, librarians, and students, as well as business professionals. We share our knowledge and peer-reveiwed research papers with libraries, scientific and engineering societies, and also work with corporate R&D departments and government entities.

More About Us