Научная статья на тему 'Geometry and Kinematics of the Mecanum Wheel on a Plane and a Sphere'

Geometry and Kinematics of the Mecanum Wheel on a Plane and a Sphere Текст научной статьи по специальности «Физика»

CC BY
0
0
i Надоели баннеры? Вы всегда можете отключить рекламу.
Журнал
Russian Journal of Nonlinear Dynamics
Scopus
ВАК
RSCI
MathSciNet
zbMATH
Область наук
Ключевые слова
Mecanum wheel / omnidirectional wheel / omniwheel / spherical robot / ballbot / forward kinematics / inverse kinematics / kinematic model

Аннотация научной статьи по физике, автор научной работы — B. I. Adamov

This article is devoted to a study of the geometry and kinematics of the Mecanum wheels, also known as Ilon wheels or the Swedish wheels. The Mecanum wheels are one of the types of omnidirectional wheels. This property is provided by peripheral rollers whose axes are deviated from the wheel one by 45 degrees. A unified approach to studying the geometry and kinematics of the Mecanum wheels on a plane and on the internal or external surface of a sphere is proposed. Kinematic relations for velocities at the contact point of the wheel and the supporting surface, and angular velocities of the roller relative to the supporting surface are derived. They are necessary to describe the dynamics of the Mecanum systems taking into account forces and moments of contact friction in the presence of slipping. From the continuous contact condition, relations determining the geometry of the wheel rollers on a plane and on the internal or external surface of a sphere are obtained. The geometric relations for the Mecanum wheel rollers could help to adjust the existing shape of the Mecanum wheel rollers of spherical robots and ballbots to improve the conditions of contact between the rollers and the spherical surface. An analytical study of the roller geometry was carried out, and equations of their generatrices were derived. Under the no-slipping condition, expressions for rotational velocities of the wheel and the contacting roller are obtained. They are necessary for analyzing the motion of systems within the framework of nonholonomic models, solving problems of controlling Mecanum systems and improving its accuracy. Using the example of a spherical robot with an internal three-wheeled Mecanum platform, the influence of the rollers on the robot movement was studied at the kinematic level. It has been established that the accuracy of the robot movement is influenced not only by the geometric parameters of the wheels and the number of rollers, but also by the relationship between the components of the platform center velocity and its angular velocity. Results of the numerical simulation of the motion of the spherical robot show a decrease in control accuracy in the absence of feedback on the robot’s position due to effects associated with the finite number of rollers, their geometry and switching. These effects lead not only to high-frequency vibrations, but also to a “drift” of the robot trajectory relative to the reference trajectory. Further research on this topic involves the use of the motion separation methods and the statistical methods for kinematical and dynamical analysis of Mecanum systems.

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Текст научной работы на тему «Geometry and Kinematics of the Mecanum Wheel on a Plane and a Sphere»

Russian Journal of Nonlinear Dynamics, 2024, vol. 20, no. 1, pp. 43-78. Full-texts are available at http://nd.ics.org.ru DOI: 10.20537/nd240201

NONLINEAR PHYSICS AND MECHANICS

MSC 2010: 70B10, 70B15, 70E18

Geometry and Kinematics of the Mecanum Wheel on a Plane and a Sphere

B.I. Adamov

This article is devoted to a study of the geometry and kinematics of the Mecanum wheels, also known as Ilon wheels or the Swedish wheels. The Mecanum wheels are one of the types of omnidirectional wheels. This property is provided by peripheral rollers whose axes are deviated from the wheel one by 45 degrees. A unified approach to studying the geometry and kinematics of the Mecanum wheels on a plane and on the internal or external surface of a sphere is proposed. Kinematic relations for velocities at the contact point of the wheel and the supporting surface, and angular velocities of the roller relative to the supporting surface are derived. They are necessary to describe the dynamics of the Mecanum systems taking into account forces and moments of contact friction in the presence of slipping. From the continuous contact condition, relations determining the geometry of the wheel rollers on a plane and on the internal or external surface of a sphere are obtained. The geometric relations for the Mecanum wheel rollers could help to adjust the existing shape of the Mecanum wheel rollers of spherical robots and ballbots to improve the conditions of contact between the rollers and the spherical surface. An analytical study of the roller geometry was carried out, and equations of their generatrices were derived. Under the no-slipping condition, expressions for rotational velocities of the wheel and the contacting roller are obtained. They are necessary for analyzing the motion of systems within the framework of nonholonomic models, solving problems of controlling Mecanum systems and improving its accuracy. Using the example of a spherical robot with an internal three-wheeled Mecanum platform, the influence of the rollers on the robot movement was studied at the kinematic level. It has been established that the accuracy of the robot movement is influenced not only by the geometric parameters of the wheels and the number of rollers, but also by the relationship between the components of the platform center velocity and its angular velocity. Results of the numerical simulation of the motion of the spherical robot show a decrease in control accuracy in

Received October 11, 2023 Accepted November 29, 2023

The work was supported by the Russian Science Foundation, grant no. 22-21-00831, https://rscf.ru/project/22-2-00831/.

Boris I. Adamov adamoff.b@yandex.ru

National Research University "Moscow Power Engineering Institute" ul. Krasnokazarmennaya 14, build. 1, Moscow, 111250 Russia

the absence of feedback on the robot's position due to effects associated with the finite number of rollers, their geometry and switching. These effects lead not only to high-frequency vibrations, but also to a "drift" of the robot trajectory relative to the reference trajectory. Further research on this topic involves the use of the motion separation methods and the statistical methods for kinematical and dynamical analysis of Mecanum systems.

Keywords: Mecanum wheel, omnidirectional wheel, omniwheel, spherical robot, ballbot, forward kinematics, inverse kinematics, kinematic model

1. Introduction

Mecanum wheels, invented in 1972 by the Swedish engineer B.E. Ilon [1], are one of the types of omnidirectional motion wheels [2]. On the periphery of each of them there are rollers, the axes of which intersect with the wheel axis at an angle of 45° (for the "classic" universal omniwheels this angle is 90°).

The design of Mecanum wheels allows a vehicle equipped with them to move in any direction with any orientation, make a turn on the spot, etc. However, when vehicles with the Mecanum wheels move, vibrations arise [3, 4]. The source of these is the switching of the contacting rollers and the imperfection of their geometric shape.

Due to its mobility and ease of parking, omnidirectional platforms are used for working in cramped conditions of warehouses, production facilities and similar premises, and for creating vehicles for people with disabilities and for other purposes [3, 5].

Omnidirectional wheels of various types are used to control the motion of spherical robots, and spherical wheels and bodies. The motion of such systems has been studied in [6-12]. For spherical robots and vehicles with a spherical wheel, it is necessary to correct the shape of the Mecanum wheel rollers to improve the quality of the contact [9, 11]. Examples of the Mecanum systems are shown in Fig. 1.

(a) 3D-model of the Mecanum wheel

(b) Spherical robot [6]

(c) Mecanum drive of the spherical wheel [11]

Fig. 1. Examples of the systems with the Mecanum wheels

In most cases, an omni- or Mecanum wheel is modeled as a disk sliding in a direction perpendicular to the axis of the contact roller. According to [2], the first studies of the Mecanum

wheels using this model were published by J.Agullo et al. [13], P. Muir and C.P. Neuman [14] in 1987. The equations of kinematics and dynamics of vehicles with an arbitrary number and location of the omni- or Mecanum wheels on a plane or a sphere were derived by A. V. Borisov et al. [15]. The application of V. Y. Tatarinov's equations to study the dynamics of an omnivehicle with an arbitrary arrangement and type of wheels is described in [16] by A. A. Zobova.

The sliding disk model is convenient for kinematic analysis and synthesis. However, when describing the dynamics of a Mecanum system, the use of this model does not allows us to take into account many effects associated with the movement and switching of rollers.

If we assume that the rollers are always in contact with the supporting surface with a central cross section [17, 18], then it is possible to take into account, for example, friction on their axes.

The first comprehensive study of the geometry, kinematics and dynamics of Mecanum systems taking into account rollers was published by G. Wampfler et al. [19] in 1989. The relations for the coordinates of the roller contact point along the wheel axis, and the relations for the velocities at the contact point were obtained. At the stage of expressing the speeds of rotation of wheels and rollers from the condition of no slippage, an unfortunate mistake was made — in some parts of the expressions, sin a and cos a were confused (possibly due to a change in the method of calculating the angle a of deviation of the roller axis from the wheel one).

A comprehensive study of the geometry of the rollers and the kinematics of the Mecanum wheels was carried out by A. Gfrerrer [20] in 2010. Using descriptive geometry methods, an equation to determine the position of the contact point and a formula for the generatrix of the roller surface, expressed in terms of the angle of rotation of the wheel, were obtained. The kinematics of the Mecanum wheels was studied taking into account the motion of the rollers.

An analysis of the influence of the design of Mecanum wheels on the accuracy of odometric navigation of the mobile robot was carried out in [21]. An improved navigation algorithm is proposed by averaging the kinematic equations over the angle of rotation of the wheel.

A study of the influence of the Mecanum wheel design on the dynamics of the omniplatform taking into account the slippage and the multicomponent contact friction was carried out in [22].

An approximation of the rollers by a set of spheres is proposed in [23]. The resulting model with two-point contact between the Mecanum wheels and the floor describes the motion of the four-wheel robot more accurately than the single-point contact model.

The "intuitive" generatrix of the Mecanum wheel roller surface is the arc of an ellipse or a circle [24-26].

With an exact (ideal) roller shape, the projection of the Mecanum wheel is a perfect circle, i.e., it can roll on a plane without vertical movements of its center.

A. Gfrerrer [20] showed that the exact generatrix of the roller is not elliptical and also proposed a method to approximate the roller with a torus. Descriptions of the Mecanum wheel roller geometry equivalent to [20] are given in [27, 28].

A study of the dependence of the magnitude of vertical vibrations on the curvature radius of the Mecanum wheel roller generatrices is given in [26]. Proposals are given for modifying the wheel design by adding the elastic elements to dampen vibrations.

In [28], an equation of the Mecanum wheel roller moving on a plane was derived. The conditions of tangency of the projections of the roller cross sections (ellipses) to the projection of the wheel (circle) on the plane xz, orthogonal to the axis of the wheel y, were used. In the case of a Mecanum wheel rolling on the external surface of the ball, the resulting equations were modified by adding the correction terms. In this case, the geometry analysis is approximate (see Appendix A), no rigorous study of the conditions of contact between the roller and the sphere

was carried out. The resulting shape of the rollers was used in the design of the Mecanum drive of the spherical wheel of the vehicle [11] (see Fig. 1c).

It should be noted that the geometry of the rollers of the Mecanum wheels, designed to move on a flat surface, has been studied in sufficient detail. The problem of synthesizing the shape of the Mecanum wheel rollers on a spherical surface requires further solutions.

The results of the study of the dynamics and modeling of the motion of the vehicles with the "classic" omniwheels, taking into account the nature of the contact of the rollers with the floor, are presented in [29-31].

In [29], the authors put forward the curious thesis that a real omniwheel is an approximate implementation of a theoretical one (i.e., a sliding disk), and not vice versa.

The aims of this study are:

• to determine the shape of the rollers of the Mecanum wheels for moving on a plane or a sphere within a unified approach;

• to obtain kinematic relationships for the wheel rotational speeds, necessary to solve control problems for Mecanum systems moving on a plane or a sphere;

• to obtain relationships for the velocities at the point of contact of the wheels with the supporting surface, and the angular velocities of the rollers, necessary for studying the dynamics of Mecanum systems, taking into account wheel slipping, the structure of the contact friction forces and moments.

Remark 1. Further, if necessary, we use the notation c( ) = cos( ), s( ) = sin( ).

2. Description of the Mecanum wheel. Motion on a plane

The Mecanum wheel under consideration consists of a hub and N rollers, evenly distributed along its periphery. The rollers passively rotate about their axes, intersecting with the wheel axis at a constant angle (for example, 45° for a Mecanum wheel and 90° for a universal omniwheel).

Let us introduce a coordinate system CXYZ with origin at the center of the wheel C (Fig. 2). CY-axis is an axis of rotation of the wheel, CXZ is a middle plane of the wheel. In all cases under consideration, the movement occurs in such a way that the Z-axis is always normal to the wheel supporting surface (a plane or a sphere, Fig. 2).

Fig. 2. Scheme of the wheel on a plane

Let p be the angle of rotation of the wheel about its own CY-axis, and y be the angle of rotation of the roller about its own axis (with a unit vector er, Fig. 2).

To facilitate further description, we introduce the angle of rotation of the contacting roller, p, about the wheel CY-axis (Fig. 2):

p = z(-z,clt),

where K is the contacting roller center. As the contacting roller is changed, the value of p jumps from fj to — fj (or vice versa, depending on the rotation direction).

The expression of p in terms of the wheel rotation angle p can be determined using mod operation of taking the remainder of division according to the formula

The deviation angle of the contacting roller axis from the plane CXZ

5 = Z(XZ, er) = Z(X, er)\g!=0 .

For a Mecanum wheel it is usually \5\ = 45°, and for a universal omniwheel, 5 = 0.

The set of rollers of an ideal Mecanum wheel for motion on a plane is enveloped by a cylindrical surface of radius R with CY-axis (Fig. 3). This enables the wheel to roll and spin, maintaining a constant distance from the center C to the supporting surface and a constant orientation of the CZ-axis.

Fig. 3. Cylindrical envelope of the Mecanum wheel rollers on a plane (the roller "meridians" are the lines of contact between the roller surface and the envelope surface; the possible directions and axes of the wheel rotation relative to the plane are shown)

Remark 2. Here and in what follows it is assumed that the surfaces of all the rollers simultaneously touch the envelope surface at any angle of rotation of the wheel.

It also follows from this that during the movement of the wheel, the contact point P of the roller with the support surface is displaced relative to the wheel center C only in the direction of the CY-axis, but not the axis CX. The axial displacement of point P is denoted by AY in Fig. 2. Y

Let us find the velocity of the roller contact point P:

vp = vc + Ocf x

t

CP + tp eY x CP + Y er x K—P.

(2.1)

where Vc = ( Vcx Vc, „ the velocity of the wheel center C; ^f = (. . %)T is the ant

gular velocity of the XYZ-frame, is the velocity of the wheel spinning;

eY = (o 1 0^ is the unit vector of the wheel axis; and er is the unit vector of the roller axis. Here all vectors are given in the XYZ-frame.

We find the coordinates of the vectors CK, er by multiplying the rotation matrix by the angle tp by the coordinate columns of the corresponding vectors at tp = 0:

CK =

cos tp 0 sin tp 0 1 0

.

(-R

— sin tp 0 cos tp y~RHJ cos tpj

H sin tp 0

cos tp 0 sin tp I cos ô\ (

1 0

sin 5

cos tp cos sin 5

5\

(2.2)

(2.3)

— sin tp 0 cos tp y 0 J y— sin tp cos ôj

Here RH = CK is the wheel hub "radius".

The vector

K—P

is

(

kP = CP-CK =

RH sin tp A,

Y

yRH cos tp — Rj

Having performed the necessary transformations in (2.1), we find the components of the velocity of the contact point P:

Vp = VC — AyQz — Rtp + yAy sin tp cos 5 + Yf(RH cos tp — R) sin 5, (2.4)

VpY = Vcy + Y(R cos p — Rh ) cos 5, (2.5)

VPz = Y(Ay cos tp cos 5 — RH sin tp sin 5). (2.6)

Since Vp = 0, from the last relation we obtain the axial displacement of the contact point

Ay = Rh tan 5 tan tp. This equation is equivalent to the results [19, 20].

(2.7)

0

e

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

r

Substituting expression (2.7) into (2.4) and (2.5) gives the following formulas for the velocity components at the contact point P:

Vpx = VCx - ttzRH tan ptan 8 - Rp ^R- sin S, (2.8)

Vpy = VCy + Y(R cos p — RH) cos 5. (2.9)

Let us write the last relations in a simplified form, expanding in pi up to the second degree inclusive:

VPv = VCv - QzRHp tan 8 — Rp — A/ yR — RH — sin5, (2.10)

Vo = VCv +7 (r-Rh~ iW) coss- (2-n)

1

rA. -¿--nr --r / y-" --n 2

1

■ l^y 1 ' V --tl 2

Express the rotational speeds of the wheel p and the contact roller j in the absence of slippage. The conditions Vp. = 0, Vp = 0 for (2.8) and (2.9) are achieved when

if VC tan 5 \

p = — VCx H--c--RH^z tan 5 tan p , (2.12)

-Ri \ cos pp /

VC

7 = —---• (2.13)

(R cos p — RH) cos 5

Let us write the last relations in a simplified form, expanding in p up to the second degree inclusive:

i

P

R

Vbv +VCy[ 1 + y ) tan 5 - QzRHp tan 8

(2.i4)

(R — RH) cos 5 \ R — RH 2

Note that from Eq. (2.13) or (2.15) it follows that the roller rotates only if there is an axial component of the wheel center velocity Vc . When Vc = 0, the Mecanum wheel or the omniwheel operates like a conventional one.

Remark 3. In the absence of a displacement of the roller contact point at p = 0, the formula for p takes the form obtained for the simplest model of a Mecanum wheel — a disk sliding in the direction perpendicular to the contacting roller axis [13, 15]:

Rp = VCx + VCy tan 5.

We complete this section by expressing the components of the contacting roller's angular velocity Or = Ocf + peY + Yer:

Qr = 7 cos 5 cos p, Qr = p + y sin 5, = — 7 cos 5 sin p, (2.16)

and also give their expansions in p: ( p2\

Q,r =y(1 —— J cos 8, Q,r = p + 7 sin 8, Q,r = i1z — Ajp cos 8. x \ 2 I Y Z

3. Kinematics of the Mecanum wheel on the internal surface of a sphere

We now turn our attention to the Mecanum wheel motion on the internal surface of a spherical shell. In this case, the geometry of the rollers differs from that discussed earlier.

The set of rollers of an ideal Mecanum wheel for moving on the internal surface of a sphere is enveloped by a self-intersecting torus surface formed by rotation of an arc of the sphere about the CY-axis of the wheel (Fig. 4). This enables the wheel to roll and spin, maintaining a constant distance from the center C to the supporting surface and a constant orientation of the CZ-axis, and during motion the contact point of the roller P is displaced relative to C only in the direction of the CY-axis. To describe the displacement, we introduce the angle a = (see Fig. 5).

Fig. 4. Toric envelope of the Mecanum wheel rollers on the internal surface of a sphere (the roller "meridians" are the lines of contact between the roller surface and the envelope surface; the possible directions and axes of the wheel rotation relative to the sphere are shown)

Let RS denote the radius of the spherical shell inside which the wheel moves (Fig. 5), and let RT = OC = const be the distance from the center of the wheel to the center of the sphere. Let us call their difference

R — Rs — R

T

the radius of the wheel.

Introduce the radius ratios

A = —

RT

R

a

H

T

where RH = CK is the hub "radius". Here A > 1, k > 0.

Consider the kinematics of the wheel motion relative to the sphere.

The velocity at the contact point P relative to the spherical shell has the form

Vp = Vc + O

c

cf

— + teY x — + yer x K~P.

(3.1)

x

sphere

sphere

(a)

P

(b)

Fig. 5. Scheme of the internal wheel in a sphere

I ^ I vc vc ^

VcY OJ the relative velocity of the center C; fÎcî = — QZJ

where Vc =

is the angular velocity of the XYZ-frame relative the sphere

I 0 \ I 0 \ I

CP = Qp-ôC =

RS sin a -RS cos a

)

0

\-rtJ

RS sin a

KP = cP-

CK =

y-RS cos a + RTJ \

RH sin p RS sin a yRH cos ip — RS cos a + RTJ

(3.2)

(3.3)

the vectors CK and are defined by formulas (2.2) and (2.3).

Having performed the necessary transformations in (3.1), we find the components of the velocity of the contact point P:

R

Vpx = y~VCx ca - RSQZ sa + p{RT - Rs ca)-

— Yf((—RT — RH cp + RS ca) sô — RS sacô sip), R

(3.4)

Vpv = ^VCy ca + 7(~(RT - Rs ca) cp - RH) c5, R

Vpz = y~VCy sa - Y{Rh sô sp - Rs sa cô cp).

To analyze the conditions of contact between the rollers and the sphere, we find the projections of the relative velocities onto the normal to the sphere n = (o — sin a cos a j and onto

the tangents X, t = (o cos a sin aj (see Fig. 5).

0

Project the velocity Vp onto the tangent and the normal to the sphere. The tangent component in the YZ-plane is

VPt = Vp ■ t = VPy ca + VPz sa =

R

= -¡^-Vc r — 7((Rjj + RTcp) cac5 + RH sasdsp — Rsc5cp). (3.5) RT Y

The normal component of the contact point velocity is

VPn = VP ■ n = —VPy sa + VPz ca = —Y((—RT cp — RH) sa c5 + RH sip ca s5).

From the condition of continuous contact between the wheel and the sphere at VPn = 0 we obtain

RH tan 5 sin p

tana = —^---—, (3.6)

RT cos p + RH

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

RH tan 5 tan p

RT tan a = —--.

I + k sec p

R

Note that, as Rs —> oo, the sphere degenerates into a plane, n = -j^- —> 0, and ETtano; —>• ^ Ay. The shape of the wheel rollers in the limiting case corresponds to the results obtained above: for RS ^^ Eq. (3.6) becomes (2.7):

Ay = Rt tan a = Rh tan 5 tan p.

Substituting into the kinematic relations, we find

i i + k cos p

cos a = == = _ , _ , , (3.7)

v I + tan2 a v (i + k cos p)2 + (k tan 5 sin p)2

tan a k tan 5 sin p ..

sma = == = _ i _ i . (3.8)

yi+tan2 a y(l + k cos p)2 + (k tan 5 sin p)2

Approximately,

p2 k2tan25 pK tan 5

cosa^l--— —--7T, sin«-

2 (I + k)2' i + K

Substitution of expressions (3.7) and (3.8) for the angle a in Eqs. (3.4) and (3.5) for VP , VPT gives cumbersome results — we do not present them here. We limit ourselves only to approximations in the angle p with an accuracy of O (p>3)

= A (1 - , %„ — tan2 s] Vn -

Pv - A I 1 " 71 haii u I VCX

2

"x V (i + k)2 2 I Cx

x rHttzp tan 5 -p(r- xk rh<? tan2^ - (3.9)

V (i + k) 2 J

i + ^^ (i + k)2 2

-7 (r-Rh- + / Xh NO tan2 S - l) RliLf> ^ sin 6,

H \1 + k (1 + k)2 J 2 J

VPt = XVCy +^(r-Rh-(r + ^ tan2 ^ cos 5.

(3.i0)

R

For small k = -j^- <C 1, the last formulas can also be expanded in k, keeping terms up to h, Kp, p2 inclusive. Having performed the expansion and the necessary transformations, we obtain

V^ =

R*VCr - üzRHp ( 1 +

R

T

R

T

R

VPT = ^VCy+^[R-RH-

tan ö — Rp — Y ^R — RH — Rp2

RHp2

sin ö,

cos ö.

(3.11)

(3.12)

In the limit, when transitioning to motion on a plane ^RT —> oo, A = —> 1, n —> 0^, formulas (3.9), (3.10) and (3.11), (3.12) for VPx, VPt change to (2.10), (2.11).

In accordance with (3.9) and (3.10), in the absence of slipping VP. = VPt = 0 the rotational speeds of the wheel and the roller are

AV

Y =

Cv

P =

Rs ca — RT

(RH + RT cp) ca cö + RH sa sö sp — RS cö cp (1 + k cp — A ca) sö + A sa cö sp

VC ca + V

C,

Y (k + cp) ca cö + k sa sö sp — A cö cp

— RTQZ sa

(3.13)

(3.14)

Substituting Eqs. (3.7) and (3.8) for a into the last expressions gives (with an accuracy of p3):

A

<P=R

1 +

RH p k tan ö ~R T(1 + h-,)2

+ u +

pp

2 1 + -¿tk tan2 ö — K2

R

(1 + k)2

VCy tan ö—

R

H

1 + k

Qz p tan ö

AV

Y

C

(R — RH ) cos ö

1 +

p2 R{ 1 + n) + Rhk tan2 Ö ~2 (R-RH)( 1 + K)

(3.15)

(3.16)

R

For k = -jf1 <C 1, the formulas for p and 7 can also be expanded in k, keeping the terms up

to k2, Kp, p2 inclusive:

p

R

R,

T

VC

C

+ VCv fl + tan- ÜzRHp (l + ) tan5

RS 2

V

7

C

R

+

R pp2

(R — RH)cosö \RT R — RH 2

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

(3.17)

(3.18)

Remark 4. In the absence of a displacement of the roller contact point at p = 0, the formula for p 1 v^.

takes the form Rp = (Vcx + tan> which is obtained for the disk sliding along the sphere in the direction perpendicular to the roller axis [6].

Let us express the angular velocity of the contacting roller as the following sum:

( VcY , • X

-jf - + 7 cos 0 cos p

"of + p eY + 7 er

—TÇ~ + P + 7 sin ^ y QZ — 7 cos ö sin p y

2

A

1

The rolling angular velocities of the roller are

Vc.

Qr _ = —— + 7 cos ö cos ip,

rx RT

VC,

Qrr = flr • T = [ ——— + ip + 7 sin 6 cos a + {Qz — 7 cos 6 sin iß) sin a. rt j

The spinning angular velocity of the roller is

( VC \

Qrn = ilr ■ n = — ——— + (p + 7 sin S sin a + (Qz — 7 cos ô sin ip) cos a. \ rt j

Let us present the expansion of the components of the angular velocity of the roller with respect to the angle 7:

ilrx =^ + 7(1-y) cos (3.19)

,2 ,7 \ ( V

arr = ( 1 - ^^ tan'*] ^ - ^J + ^^ptan^

( ip2 (2 +tan2 ö) k2 + 2k\

+ (1 + «)»-H

(3.20)

^ Kip tan ö Vcx .] „ A p2 k2 tan2 ö\ / k tan2 ö\ _ r

= ; , .. I -1Ç - V ) + ( l - ^TT^—^ ) - 7 ( I + ) ^cosô. (3.21)

rn 1 + k \RT ^ 2(1 + k)2 J ' V 1 + K

For 1, the last two relations can also be expanded in k, keeping terms up to k2

t

Kip, ip2 inclusive:

Vc R

Q,rr = —+ <p + 7sini + —^ttz<ptand, (3.22)

RT RT

Qrn = Qz-tp^y cos 6 + ^ - + 7 sin ¿j tan ¿j . (3.23)

4. Kinematics of the Mecanum wheel on the external surface of a sphere

Let us turn our attention to the motion of the Mecanum wheel on the external surface of a spherical shell. In this case, the geometry of the rollers differs from those discussed earlier.

The set of rollers of an ideal Mecanum wheel for moving on the external surface of the sphere is enveloped by the surface of a ring-shaped torus formed by rotation of an arc of the sphere about the CY-axis of the wheel (Fig. 6). This enables the wheel to roll and spin, maintaining a constant distance from the center C to the supporting surface and a constant orientation of the CZ-axis, and during motion the contact point of the roller P is displaced relative to C only in the direction of the CY-axis. To describe the displacement, we introduce the angle a = (see Fig. 7).

Fig. 6. Toric envelope of the Mecanum wheel rollers on the external surface of a sphere (the roller "meridians" are the lines of contact between the roller surface and the envelope surface; the possible directions and axes of the wheel rotation relative to the sphere are shown)

Fig. 7. Scheme of the external wheel on a sphere

Let RS denote the radius of the spherical shell outside which the wheel moves (Fig. 7), and let RT = OC = const be the distance from the center of the wheel to the center of the sphere. Call their difference

R — RT — R<S

the radius of the wheel.

Introduce the radius ratios

RS

X = lf> K RT

R

H

T

where RH = CK is the wheel hub "radius". Here 0 <A< 1, k> 0.

Consider the kinematics of the wheel motion relative to the sphere.

The velocity at the contact point P relative to the spherical shell has the form

VP — VC + ncf x C——

'p — VC t

+ p eY x CP + Y er x K—f.

(4.1)

Here VC = (Vcx is the relative velocity of the wheel center C; Ocf =

( vc vc ^T

= ^——i- ftzJ is the angular velocity of the XYZ-fvame relative the sphere:

of — oP-CHC —

~kP — cf-

( o N

—RS sin a y RS cos a

/

o o

RT

—RS sin a \rRs cos a — RT

CK —

RH sin Lp —RS sin a ^RH cos p + RS cos a — RTJ

(4.2)

(4.3)

the vectors CK and are defined by the formulas (2.2) and (2.3).

Comparison of formulas (3.1)-(3.3) with similar ones (4.1)-(4.3) shows that all kinematic formulas obtained in Section 3 for the wheel inside the sphere can be extended to the case of the external wheel by a formal substitution

RS

—Rs , Rt —^ —Rt , K —y —K.

Below we present only the main results on the kinematics of the Mecanum wheel on the sphere.

The velocity components of the contact point, P, have the form R

= R^Vcx Ca + Rs^z Sa"

— p(RT — RS ca) — Y((RT — RH cp — RS ca) s¿ + RS sacô sip),

R R R

VPv = ^Vn ca + 7((RT - Rs ca) c^ - RH) cô,

(4.4)

RT cy

Vpz = sa - 7(RH s5 sp + Rs sa c5 cp).

o

To analyze the conditions of contact between the rollers and the sphere, projections of relative velocities onto the normal n = ^0 — sin a cos aj and tangents X, t = ^0 cos a sin aj (Fig. 7) are used.

Project the velocity VP onto the tangents and the normal to the sphere. The tangent

component in the YZ-plane is

R

VPt = VP ■ t = -¡^-Vc r — ~ Rt C(?) cac$ + Rh sas5sp + Rsc5cp). (4.5)

Rt Y

The normal component of the contact point velocity is

VPn = VP ■ n = —Y/((RT cp — RH) sac5 + RH spcas5).

From the condition of continuous contact between the wheel and the sphere at VPn = 0 we obtain

RH tan 5 sin p . „ .

tana = --z-^—ft, 4.6

RT cos p — RH

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

RH tan 5 tan pi

RT tan a =----.

1 — k sec p

As RS the sphere degenerates into a plane, RT tan a ^ — AY and k ^ 0. The shape of the wheel rollers in the limiting case corresponds to the results obtained above: for RS the formula takes the form

Ay = —Rt tan a = Rh tan 5 tan p.

Using (4.6), we find

1 1 — k cos p , t

cos a = . == = _ i _ i , (4.7)

v 1 + tan2 a \J (1 — k cos p)2 + (k tan 5 sin p)2

tan a —k tan 5 sin p . „ .

sin a = —p = _ r —- (4.8)

v 1 + tan2 a \J (1 — k cos p)2 + (k tan 5 sin p)2

for substitution into the subsequent kinematic relationships.

Substituting (4.7) and (4.8) into formulas (4.4) and (4.5) gives cumbersome and vast relations for VP , Vpt. Let us expand them into a series in terms of the parameters k and p up to cubic terms:

R / R _ R \ ( 1 \

VpY = j^VCx - nzRHp [l - —J J tan 5-Rp-Y^R-RH--RHp2 J sin 5,

VPr = ^VCy + 7 (^R — Rh ~ cos S.

In the absence of slipping VP = VPt = 0 from (4.4)-(4.8) we express the rotation velocities of the wheel and roller:

1

<P

R

_

(4.9)

Rs (Vcv + ^ f 1 + ^r^-) tanô) - nzRHp (l - ^ ) tan5

RT \ Cx Cy \ RS 2 J J Z H r \ RT

7 =__Yet_ (*s + ). (4.10)

' (R-RH)œsô \RT R-RH 2 1 { '

These relations are expanded in terms of the parameters k and p up to cubic terms.

Concluding the study of the kinematics of the Mecanum wheel on the sphere, we consider the components of the relative angular velocity of the roller Qr = Ocf + peY + Yer. The rolling angular velocities of the roller are

Q,r _ = Qr ■ e Y = —jr^- + Y cos 5 cos (p X RT

Vc \

Qrr = ilr ■ t = —— + p + y sin 5 cos a + (Qz — 7 cos 5 sin (p) sin a. \rt )

The spinning angular velocity of the roller is

fVC N

Qrn = Qr ■ n = — + tp + y sin 5 sin a + (Qz — y cos 5 sin ¡p) cos a.

\rt j

The expansions in terms of parameters k and p, up to cubic terms, have the form

VC / in2 \ VC R _

Qrx = -j^- + y - yJ cos 5, firr = -j^- + tp + y sin 5 - j^^zf tan 5,

R

flrn = Qz — ip I y cos 6 —TT-iP + Y sin tan 6

\ RT

5. Geometry of the rollers of the Mecanum wheels

Using the geometric relations obtained above, we describe the shape of the roller of the ideal Mecanum wheel.

Let us obtain the equations of the roller surface. We assume that the generatrix considered lies in the K£{-plane, where the K^-axis is directed along the roller symmetry axis (with the unit vector er), and is perpendicular to it.

Find the coordinates of the contact point P in the axes of the roller. To do this, we decompose into components parallel and perpendicular to er and find their lengths Z and £, respectively:

Z = KP ■ er, { = e x [KIP x er]|.

The dependence £(Z) expresses the change in the radius of the cross-section of the roller along the length of its axis.

Let us obtain the following equations of the generatrix in parametric form. For the Mecanum wheel on the plane:

Zpln = R cd s<p + Ay s^ = R cos 5 sin <p + RH tan 5 sin 5 tan <p, (5.1)

Cpln = yJ(AY c5 - R s5 sp)2 + (RH — R cp)2 = (R cos <p — RH) \Jsin2 5 tan2 <p + l. (5.2)

For the Mecanum wheel on the internal surface of the sphere:

Zint = (RS ca - RT) c5 sip + RS sa s5, Cint = sJiRgSacd - (Rsca - RT) s5cp)2 + (RH - (Rsca - RT) cp)2,

where cos a and sin a are defined by Eqs. (3.7) and (3.8).

For the Mecanum wheel on the external surface of the sphere:

Zext = (RT — RS ca) c5 sp — RS sa s5, (5.3)

Cext = \J(Rs sa c6 + {RT - Rs ca) s6 sp)2 + {RH - (RT - Rs ca) cp)2, (5.4)

where cos a and sin a are defined by Eqs. (4.7) and (4.8).

Consider the asymptotic formula for the dependence of the radius of the cross section of the roller £ (Z), obtained by decomposition of degrees Z:

2!

where Dk are coefficients defined by the formula

D

4!

dZk

using the rule of implicit differentiation

C=o

dZk

</5=0

IZI < Zm,

k = 2, 4,

_ dip

and Zm = Z \ip=n/N ^s the length of the roller semiaxis. Let us write out the values of Dk and Zm at |5| = 45°

for the Mecanum wheel on the plane:

D

pln

1

R + R

D

pln

=3

RR

H

H

ln R + RH 2RH - Rip;i

W V2 V2 6 '

(R + Rh )4:

n

N]

for the Mecanum wheel on the internal surface of the sphere:

D2nt

1 + 2K

R + RH + 2RK '

D4nt = —3 ■

(1 + 2K)4R + (12K3 + 16K2 + 4K — 1) RH

(R + RH + 2RK)4

(e.,.3 ,

.int _ R + RH + 2Rk _ (2 -2k- 7k2) Rh - (8k3 + 5k2 + k + 1 )Rp3 im f-r, ! n P 4

+ k) r ' v2(1 + k)3

for the Mecanum wheel on the external surface of the sphere:

6

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

r-jext D2

1- 2K

R + RH — 2RK

D4ext = 3

(1 — 2K)4R — (12K3 — 16K2 + 4K + 1) R

H

(R + RH — 2RK)4

,.2\ n i /'e.,.3 r„.2

.ext _ R + RH — 2Rk _ (2 + 2k - 7k2) Rh + (8k3 - 5K2 + k - l) R p (im \ P ^

— k)

— K)3

6

p

n

N]

p =

n

N'

d

3

With an arbitrary S, the expressions for Dk and Zm are more cumbersome. For example, for the wheel inside the sphere we get

D

int 2

1 + 2k + cos 2S

R + RH + 2Rk + (R - RH) cos 2S'

D

int _ 3 ((128k4 + 256K3 + 288K2 + 160K + 35) R + (80K3 + 64K2 + 16K - 3) RH)

'4 ' =

8(R + RH + 2Rk + (R - RH) cos 2S)4

^ ^ /i«^^ ^ ^^^ ^ ^ i? _i_ f„■ _ «^3^ ll Tr,

cos 28—

24 ((32k3 + 48k2 + 30k + 7) R + (k - 8k3) RH)

8(R + RH + 2Rk + (R - RH) cos 2S)4

2 + 24K + It II. - I 4K + I6K +4K - II (I.k I

cos 4S—

12 ((24k2 + 24k + 7) R - (4k3 + 16k2 + 4k - 1) RH)

8(R + RH + 2Rk + (R - RH) cos 2S)4 24(2Ek + R- Rhk) cos 66 + 3(E - RH) cos 85 8(E + + 2Ek + {R - RH) cos 2^)4 ' .int _ R + RH + 2Ek + (E - EH) cos 25 _ U ~ 2(k + 1) cos 5

(13k2 + 2k - 2) RH + (16k3 + 11k2 + 7k + 3) Rip3

+

8(1 + k)3 cos3 S 6

3k2rh + (2k3 - 3k2 - 3k - 1) R i3

+---t-r^-tt-J——cos 2d+

2(1 + k)3 cos3 d 6

(k2 + 2k - 2) RH - (k2 + 5k + 1) Rip3

+ --an 1^3 3 a--— 7T cos

8(1 + k)3 cos3 S 6

Similar expressions for the Mecanum wheels on the plane and outside the sphere can be obtained by the rule

Df (k) = Dknt(-K), Dpln = Dknt(K = 0);

cmxt(k) = cmnt(-K), cmln = zmnt(K = 0).

R

Analysis of the relationship shows that, for small values of k = -b2- <C 1

|Dkxt I <

Dkpln

< |Dkntl

k

int

zext < zpln < zi mmm

Thus, the roller of the Mecanum wheel for the internal surface of the sphere is slightly longer than the others and has more curvature of the generatrix. The roller for the outer surface of the sphere is slightly shorter than the others and has less curvature of the generatrix.

Figure 8 shows the shapes of the rollers and graphs of their generatrices for a Mecanum wheel with N = 6 rollers, radius R = 50 mm and hub radius RH = 35.5 mm. The specified parameters are given for the wheels of the KUKA youBot [32] robot.

Note that, for k & 0.5, the wheel roller generatrix for the external surface of the sphere differs slightly from the straight line (for k = 0.5, the coefficient Dext = 0, but at the same time D4xt = 0). For the rollers in Fig. 8b, this property is achieved at k = 0.45 (curves 4b).

Figure 9 shows the positions of the Mecanum wheel rollers when rolling on a plane or a sphere. The shape of the rollers is in agreement with the results obtained above. Note that, while maintaining a constant distance to the support surface, the rollers do not go beyond it.

f, mm

(a) Shapes of the rollers at RS = 200 mm, k = 0.237. 1 — wheel on a plane; 2 — wheel outside a sphere; 3 — wheel inside a sphere

(b) Shapes of the rollers at different radii of the sphere. 1 — wheel on a plane; wheel inside a sphere: 2a — RS = 228 mm, k = 0.2; 3a — RS = 139 mm, k = 0.4; 4a — RS = 109 mm, k = 0.6; wheel outside a sphere: 2b — RS = 187 mm, k = 0.15; 3b — RS = 68 mm, k = 0.3; 4b — RS = 29 mm, k = 0.45

Fig. 8. Shapes of the Mecanum wheel rollers (R = 50 mm, RH = 35.5 mm, N = 6)

At the end of this section, we note one property of the track of the Mecanum wheels on the xy plane (Fig. 10).

Consider the motion of the center of the wheel with velocities XC = VC = const, yC = = VCy =0, QZ = 0. In the absence of slippage, the contacting rollers do not rotate, 7 = 0, and R(p = VC . The coordinates of the point of contact of the roller with the supporting plane are as follows:

xP = Rp, yP = Ay = RH tan 5 tan p.

(b) Wheel inside a sphere

(c) Wheel outside a sphere Fig. 9. Position of the rollers during the rolling of the Mecanum wheel on a plane or a sphere

The corresponding graph is shown in Fig. 10b for the values N = 6, R = 50 mm, RH = = 35.5 mm [32].

In Fig. 10a, the "meridians" of the roller are the geometric places of the contact points P at VCy =0, QZ = 0 at various initial angles 7 (i.e., the tracks of the plane on the roller). In all

other figures, the surfaces of the rollers are generated in a similar way.

(a) VP, mm

▲ nri

¿\J 1 n y

1U

— 50 / 1 n 5 0

/ on s

W Z\J w

xP, mm

(b)

Fig. 10. Track of the Mecanum wheel when rolling on a plane The average slope of the track to the £-axis (see Fig. 10) is

tan a =

Vp

yp

RH tan ö tan tp

Rip

ip=n/N

1 +

3N'2 J R

tan ö.

Using this formula, the value of the angle ö or the hub radius RH can be experimentally determined from the wheel track.

6. Example: a study of the kinematics of a spherical robot with an internal mecanum platform

6.1. A scheme and basic kinematic relationships

As an example, consider the motion of a spherical robot with an internal three-wheeled Mecanum platform.

x

(c)

Fig. 11. Scheme of the spherical robot (1-3 — Mecanum wheels, 4 — platform, 5 — spherical shell)

A robot scheme is shown in Fig. 11. The internal platform 4 is driven by symmetrically located Mecanum wheels 1-3, oriented normal to the spherical shell 5. The spherobot moves along the horizontal plane xy.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

The angles of deflection of the roller axes for all wheels are the same:

= ¿2 = ¿3 = S = 45° •

Let OXpYpZp be a coordinate frame of the platform 4 with origin at the center of the sphere O. Coordinate frames CiXiYiZi, i = 1, 2, 3, with origins at the centers of the wheels Ci

are introduced similarly to the coordinate systems CXYZ discussed above (the wheels rotate about the CYraxes). These coordinate frames are fixed relative to OXpYpZp, their positions are described by the angles

Pii = Z(Z„,Zi), P2l = & = Z(X„,Xi), i = 1, 2, 3.

Here

cp1i - sPii 0 1 0 0 cPii - sPii cP2 sPii sP2

ri = sp1i cPii 0 0 cP2 - SP2 = sPii cPii cP2 - cPii sP2

0 0 1 0 sP2 cP2 0 sP2 cP2

Pii = -90°, ,012 = 30°, A3 = 150°, ¡32 = 45°.

The transformation of vectors during the transition from XiYiZi to XpYpZp is carried out by a matrix of direction cosines

(6.1)

which is the product of the rotation matrices by the angles Pu and P2.

The robot's motion is considered only at the kinematic level. The following assumptions are made:

• the spherical shell does not slip on the plane, there is no spinning;

• the wheel rollers do not slip on the sphere;

• the platform moves translationally, the plane XpYp is parallel to xy, the angle of rotation of the platform ^ = Z(x, Xp), see Fig. 11;

• the wheel drives are ideal: they precisely track the given desired wheel speeds , i = 1, 2, 3.

Denote by VL and VT projections of the velocity of the sphere center O on the axes Xp and Yp (Fig. 11):

VL = Xcos ^ + ysin ^, VT = — Xsin ^ + ycos ^,

where x and y are the coordinates of the center O of the sphere.

The absolute angular velocity of the sphere and the platform in the XpYpZp-frame is

(p) _ i__\t_

Vr V,

—L. f)

D D V

t

uPp) = (00

t

where the superscript (p) indicates the platform in the XpYpZp-frame.

The angular velocity of the platform relative to the sphere in the XiYiZi-frame is

rT (Jp) - Jp)\ =

cP

1i

sPii

0

- S^ii Cp2 CPU Cp2 S^2 S^ii SP2 - cPii SP2 CP2

îvt\

-VL

[tp rs)

We get

VT VL

^xi = tt~ ('fhi tt

R,

R<

VT VL •

ton = --fT SpH Cp2 - -7T ('Ai Cp2 + i> Sp2)

R

S

R

S

VV

^Zi = -FT spi* s p2 + -FT cpi* s p2 + i> cp2-

RS RS

s

1

The velocity of the wheel center Ci relative to the sphere is

VC. = O x (OCfi,

where O—fi =(0 0 —R^jT in the XiYiZi-frame.

The components of the relative velocity of Ci are

R

= -nYiRr = -jf(VT sPh cp2 + UL cpu cfi2) - Rj<ip sp2,

* * RS

R

Vc.Y. = nXlRT = -f{VTcpu - VLSf3u),

* * RS

Vc. z. = 0.

Substituting expressions for VC X , VCY, ^Zi instead of VC , VCy, QZ into (3.14) gives "full-size" equations for determining the wheel speeds

p, = uFi(VL,Vt, VO, i = 1, 2, 3; (6.2)

(1 + k cpi — A cai) sSi + A sai cS, sp,

P i =

i RS cai — RT

Vc Y cat + Vc Y , v ' ^ , ^ » ' ^ * ' » p „ -RTQZi sa* CXi i C*Yi (k + cpj cai cS, + k sai sSi sp, — A cSi cpi T Zi i

1 + k cpi k tan si sp,

■sj(l + k cpj2 + (ktan 5i spj2 sj(l + k cpj2 + (ktan 5i spj2

A similar substitution into (3.17) gives "reduced" equations for determining the wheel speeds

pi = uRi(VL,VT, VO, i = 1, 2, 3; (6.3)

p i

R

£ {vc,x, + VC,Y, (i + ) ta,lSi) - (l + ^ ]

6.2. Simulation methodology and initial data

An analysis of the accuracy of the spherical robot motion and the influence of the geometry of the Mecanum wheels on it is carried out as follows:

1. The desired motion is set — the required position of the robot center and the angle of rotation of the platform are specified:

X = xd (t), y = yd (t), V = Vd(t), Vf = Xd cos Vd + yd sin Vd, VTf = —Xd sin ipd + yd cos tpd.

2. To determine the wheels' rotation velocities for the desired motion, kinematic equations derived without taking into account the displacements of the rollers' contact point and the sphere (a = 0, p = 0) are used:

pd = UFi(Vd, Vd, V>d)

_ , i = 1, 2, 3;

ip=0

<Pi= J cp2 - tan 5i)Vg + (sf3u cf32 + cf3u tan SJVj! - Rsipd sf32

1

3. The robot motion is determined by numerical solution of the kinematic equations

x = VL cos i — VT sin i, y = VL sin i + VT cos i, uFl(VL,Vt,i) = $ or urz(Vl,Vt,i) = rf, i = 1, 2, 3.

Consider several desired motions at 0 ^ t ^ tf with trajectories representing a square with side 2p or a circle of radius p. Choose

p = 0.2 m, tf = 4 s.

The translational motion along the square is

(A)

x; d = 0, yd = V d, id = 0, 0 < t /A it

x; d = Vd, yd = 0, id = 0, tl < t < 2t1

x; d = 0, yd = —Vd, id = 0, 2tl < t < 3t1

x; d = —Vd, yd = 0, id = 0, 3ti < t < 4t1

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

with xd(0) = yd( 0) = 0, Vd = = 0.4 m/s, tx = Is. The translational motion along the circle is

; d « t rd 2np . 2nt

r = 0, V£ = —-sm —, tf tf

with xd(0) = yd(0) = 0, id(0) = 0.

The longitudinal motion along the circle is

; d 2n d ; d 2np

0 = -~r, V£ = -pipd =

tf tf

with xd{0) = yd{0) = 0, tpd{0) = §.

The lateral motion along the circle is

T tf tf

Vd = 0

id = —

2vr

¿7'

VL = 0, Vd = — pid =

2vrp

17

(B)

(C)

(D)

with xd(0) = yd(0) = 0, id(0) = 0.

All of the specified trajectories are traversed clockwise, and their origin coincides with the origin of the coordinates xy.

Consider two sets of geometric parameters of the robot corresponding to different sizes of the wheels and the spherical shell:

R = 50 mm, RH = 35.5 mm, RS = 200 mm, k = 0.237, A = 1.333; (I)

R = 70 mm, RH = 55.5 mm, RS = 170 mm, k = 0.555, A = 1.7. (II)

The number of rollers on each wheel is N = 6 or N = 8.

When choosing parameters (I), the characteristics of the wheels [32] were used; the choice of parameters (II) and the laws of motions (A), (B) is based on [6].

6.3. Simulation results: the effect of the simplification of the kinematic equations

Using the example of motion (A), let us compare simulation results when using the "full-size" wFi(VL, VT, tp) = pd and the "reduced" uRi(VL, VT, tp) = pd kinematics equations for expressing the platform velocities VL, VT, tp.

Figure 12 shows graphs of the trajectories of the robot center and the angle of rotation of the platform with geometric parameters (I) and N = 6 rollers at p1 (0) = p2(0) = 0, P3(0) = 0-3. The indicated graphs for the "full-size" and the "reduced" kinematics equations practically merge with each other. The velocity mismatch when using the specified kinematic relationships

ar-f(vx) = x— x\ n

is no more than 4 • 10 4 m/s. On average AR_F(vx) & 10 4 m/s, which gives about 4 • 10 4 m x-coordinate mismatch during the movement.

ip, deg 0.4

V, m

0.1

1 / / 2 3

0 1

02

03

0.4

0.2

-0.2 -0.4 -0.6 -0.8 -1.0

1 r^

If] 4

\ 2~I

\*r3

x, m

ii—F

0.004 0.002

-0.002 -0.004

(b) Platform rotation angle ^

K)> m/s

t, s

(a) Trajectory of the center O

(c) Methodical mismatch in velocity vx

Fig. 12. Motion along the square: comparison of the kinematic equations (parameters (I), N = 6). 1 — desired motion (A); numerical simulation results using: 2 — the "full-size" Eqs. uFi = 3 — the "reduced" Eqs. uRi =

At the same time, the kinematic errors of the motion tracking

Avx = x — x d, Avy = y — yd, Ax = x — xd, Ay = y — yd (Fig. 13) are greater than the specified methodological errors by two orders of magnitude: max \Avx| & max \Avy\ & 0-04 m/s, max\Ax\ =14 mm, max \Ay\ =9 mm-

Thus, in the case under consideration, the simplification of the kinematics equations gives negligible methodological errors.

Avx, m/s 0.03

(a) v^-velocity error

(b) vy-velocity error

Ax,

-0.005

-0.010

^v1 2 V 5 4

Ay, m

t, s

t, s

(c) ^-coordinate error

(d) ^-coordinate error

Fig. 13. Velocity and position errors when tracking motion (A) (parameters (I), N = 6). 1 — errors; 2 average errors, trends

The change in errors Avx, Avy is of a high-frequency nature, caused by an abrupt change in ipi when changing the contacting rollers. Due to the nonzero average values Avx, Avy, caused primarily by the presence of tp2 in the kinematic equations, the errors Ax, Ay have piecewise linear trends (Fig. 13), explaining the "drift" of the trajectory compared to the desired one.

Now let us consider numerical simulation results for the robot motion with geometric parameters (II), with N = 6 and N = 8 rollers. Graphs of trajectories of the center O, angles methodological velocity errors AR_F(vx) for the robot at p1(0) = p2(0) = 0, P3(0) = 0-3 are shown in Fig. 14.

For N = 6 rollers, the methodical mismatch in angle ^ reaches 0-5°, and the maximum mismatch in velocity is max|AR_F(vx)| = 0-01 m/s. At N = 8, the indicated errors decrease by a factor of several and correspond to the values obtained for the robot with parameters (I) (Fig. 12).

Further, the "reduced" equations are used in simulating the robot motion with parameters (I), since this does not lead to a loss of accuracy, but allows one to reduce computational costs; and for the case of parameters (II), the "full-size" equations are used.

6.4. Simulation results: analysis of the accuracy of motion

Let us consider the characteristics of the accuracy of tracking of motions (A)-(D).

The accuracy analysis is performed based on a set of simulation results obtained for an aggregate <J>0 °f 40 triplets of initial conditions {p1(0), p2(0), ¥>3(0) }> where Pj(0) e [—f, f] were generated as independent uniformly distributed random variables.

The following characteristics of the desired motion tracking accuracy are used below:

• a position error

A r = \J (x — xd)2 + (y — yd)2 _RUSSIAN JOURNAL OF NONLINEAR DYNAMICS, 2024, 20(1), 43-78 _

V, m

0.4

0.3

0.2

0.1

2

0

0

0 3 0.4

(a) Trajectory of the center O, N = 6

(c) Rotation angle of the platform, N = 6

AR-F(VX), m/s 0.010 r

0.005

-0.005

0.4

0.3

0.2

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

x, m

? /

ÔT 02 0

13 0.4

(b) Trajectory of the center O, N = 8

x, m

._ — _ LL ^ tfWv f\-2-r-A

i ■1K7AS

t. V \f

i. i » V

i. 3 V

t, s

(d) Rotation angle of the platform, N = 8

AR~F(VX)> m/s 0.004

0.002

-0.002 -0.004

(e) Methodical mismatch in velocity vx, N = 6 (f) Methodical mismatch in velocity vx, N = 8

Fig. 14. Motion along the square: comparison of the kinematic equations (parameters (II)). 1 — desired motion (A); numerical simulation results using: 2 — the "full-size" Eqs. uFi = 3 — the "reduced" Eqs. wRi = $

and its maximum value on the aggregate

Armax = max maxAr;

an angular error

A^ = ^ -

and its maximum value on the aggregate

A^max = max max |A^|;

average errors along the trajectory length

\„t _ ^ max a i t _ ^0max

' a.v £ ' ra.v £ !

where t is the length of the reference trajectory (t = 8p for motion (A), t = 2np for motions (B)-(D));

estimates of a maximum error growth rate along the trajectory length

/ ^rmax A .i.i

Ar = max A# =

max max

t max t tAr

max rmax

where tAr , tA. are, respectively, the path traveled along the reference trajectory when

A'max Armax

reaching the maximum Ar and |A^|.

Note that in all the cases under consideration, the maximum of A^ on the aggregate of the initial conditions is reached at t = tf or t & tf, which is why

^max ~ A^lv ■

Table 1. Accuracy of the desired motions tracking

Desired Geometric N Ar max. A re Are max. AViv,

motion parameters mm 111111 / 111 mill/111 deg deg/m

(I) 6 17.0 10.6 21.1 1.7 1.1

(A) 8 9.0 6.1 11.9 1.0 0.6

ÎTTÏ 6 35.0 21.9 21.8 5.1 3.2

l11,! 8 13.6 8.5 10.8 2.3 1.4

(I) 6 19.4 15.4 24.3 1.86 1.5

(B) 8 11.8 9.4 14.7 1.42 1.1

ÎTTÏ 6 30.0 23.8 23.9 7.0 5.6

l11,! 8 18.2 14.5 14.6 3.9 3.1

(I) 6 14.8 11.8 22.9 0.85 0.7

(C) 8 8.5 6.8 12.6 0.43 0.3

CTT1 6 18.5 14.7 25.7 3.9 3.1

8 10.2 8.1 15.8 2.2 1.8

(I) 6 97.6 77.7 110.2 23.1 18.4

(D) 8 69.2 55.1 76.2 17.4 13.8

i'TTI 6 76.9 61.2 112.8 9.3 7.4

l11,! 8 36.8 29.3 68.5 5.1 4.1

The maximum desired motion tracking errors, as well as estimates of their growth rates, are given in Table 1.

The robot's motion is illustrated by graphs of the trajectories of the center O, the angles of the platform rotation and the positional error Ar (Figs. 15-18). The areas in which the entire set of graphs is located for ^(0) E are shown, as well as two examples of curves corresponding to specific values of the initial wheel rotation angles.

0.3

0.2

0.1

0.1 0.2 0.3 0.4

(a) Trajectory of the center O, parameters (I)

V, m

0.3

0.2

0.1

x, m

0.1 0.2 0.3 0.4

(b) Trajectory of the center O, parameters (II)

0.005

12 3

(c) Position error, parameters (I)

Ar, m 0.035 0.030 0.025 0.020 0.015 0.010 0.005

12 3 4

(d) Position error, parameters (II)

(e) Rotation angle of the platform, parameters (I) (f) Rotation angle of the platform, parameters (II)

Fig. 15. Accuracy of the motion (A), N = 6

The simulation results show that increasing parameter k and decreasing N (that is, increasing the magnitude of pj leads to a decrease in the accuracy of the motion.

V, m

V, m

x, m

(a) Trajectory of the center O, parameters (I)

Ar, m 0.020

0.015

0.010

0.005

12 3

(c) Position error, parameters (I)

x, m

(b) Trajectory of the center O, parameters (II)

Ar, m 0.030 0.025 0.020 0.015 0.010 0.005

12 3 4

(d) Position error, parameters (II)

deg

2.0

(e) Rotation angle of the platform, parameters (I) (f) Rotation angle of the platform, parameters (II)

Fig. 16. Accuracy of tracking of motion (B), N = 6

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

When tracking motions (A), (B), (C), positional errors with the same combinations of the geometric parameters and the number of rollers do not differ much from each other. Here the rate of growth of the positional error is Armax & 21 ...25 mm/m for N = 6 and Armax & & 11... 15 mm/m for N = 8 (Armax depends weakly on other parameters, see Table 1).

However, for motion (C) (the longitudinal motion along the circle, Fig. 17), the main deviation Ar is achieved in the direction of the trajectory, and for motions (A) and (B), in the lateral direction relative to the trajectory (Figs. 15, 16).

Remark 5. The qualitative appearance of the graphs Ar(t), A^(t) for motions (A)-(D) is approximately the same; for motions (C), (D) these graphs are not given.

Fig. 17. Trajectories of the robot center when tracking the longitudinal motion along the circle (motion (C), N = 6)

The positional errors and their growth rates when tracking motion (D) (the transversal motion around a circle, Fig. 18) are four times greater than those for other motions. Errors in the platform rotation angle A^ also increase many times over. For geometric parameters (I) and N = 6, the maximum error in angle for motions (A), (B), (C) is A^max & 1° ... 2°, but for motion (D) it is A^max & 23°.

Thus, the accuracy of the desired motion tracking depends not only on the geometric parameters of the robot, but also on the combination of velocity and direction of motion, and the speed of rotation of the platform. In some cases (for example, for motion (D)), a "resonance" occurs, in which the rate of the error growth becomes significantly greater than that for the "nonresonant" motions (for example, motions (A)-(C)).

It is also possible to distinguish the "antiresonance" motion (C), during which the lateral deviation from the reference trajectory is significantly less than that in other cases.

7. Conclusion

In this article, the kinematic relations for the Mecanum wheels moving on a flat or a spherical surface are obtained. From the condition of continuous contact with the supporting surface VPn = = 0, the equations for the displacement of the contact point in the direction of the wheel axis were obtained, which were used to study the geometry of the wheel rollers.

In contrast to studies [19, 20, 27, 28], the geometric relationships for the roller were obtained based on the analysis of the kinematics of velocities, which made it possible to quite easily generalize the technique to the cases of the wheel motion on a sphere or in it.

The kinematic equations obtained in Section 3 for the motion of the wheel on the internal surface of a sphere can be considered, in a sense, universal:

• the substitution

k — 0, A — 1, RT — RS — x gives similar equations for motion on a plane;

x, m

x, m

(a) Parameters (I), N = 6

(b) Parameters (I), N = 8

1 0 2 0

x, m

-0.2

x, m

-0.2

(c) Parameters (II), N = 6 (d) Parameters (II), N = 8

Fig. 18. Trajectories of the robot center when tracking the lateral motion along the circle (motion (D))

• the substitution

K —y —K, Rs —y —Rg, Rs — R = RT —y —RT = —Rg — R gives similar equations for motion on the external surface of a sphere.

The equations for the rotational velocities of the wheels and the rollers p, j are necessary for analyzing the motion of systems within the framework of nonholonomic models, solving problems of controlling Mecanum systems and increasing their accuracy.

The equations for the velocity components VP , VPt of the contact point and the angular velocities of the roller relative to the supporting surface Q , QrT, Qrn are necessary to describe the dynamics of Mecanum systems taking into account the contact friction forces and moments in the presence of slipping.

The geometric relationships for the rollers of the ideal Mecanum wheels will help to adjust the existing shape of the Mecanum wheel rollers of spherical robots and ballbots to improve the

contact conditions between the rollers and the spherical surface. The need for such a correction is evidenced by the results of practical studies [9, 28].

The results of the numerical simulation of the motion of the spherical robot with the internal three-wheeled Mecanum platform show a decrease in control accuracy in the absence of feedback on the robot position due to effects associated with a finite number of the rollers, their geometry and switching. These effects lead not only to high-frequency vibrations, but also to a "drift" of the robot trajectory relative to the desired one. Compensation of this effect by means of positional feedbacks requires an additional energy consumption.

The qualitative appearance of the trajectories of the spherical robot is consistent with the experimental results [6-8].

The simulation results show that the accuracy of the desired motion tracking is affected not only by the geometric parameters of the rollers, but also by the ratio of the velocity components of the Mecanum platform, which in some cases leads to a significant increase in errors.

Further research on this topic involves the use of motion separation methods and statistical methods for analyzing the kinematics and dynamics of Mecanum systems.

Appendix A. Comparison of the geometry of the Mecanum wheel rollers on a sphere

Let us compare Eqs. (5.1)-(5.4) describing the geometry of the rollers with similar results obtained in [28]:

Zpln _ zext _

s/R2 - S2

eln = {VR2 -S2- Rh)2 +1 ((v/i^si- Eh)

rt = epln + Rs_ ^R2_(s+l^y/R2_S2_RH)

-S

s/R2 - S2

-S

s/R2 - S2

mm

20

18 16 14 12 10 8 6 4 2 0

^2b

281s

laN

\ lb

0

10 20 30 40

50 60

70

80 90

mm

Fig. 19. Roller generatrices for the Mecanum wheel (R _ 100 mm, RH _ 80 mm) on a plane or on a sphere external surface (RS _ 180 mm). Wheel on a plane: 1a — Eqs. (5.1), (5.2); 1b — Eqs. [28]; wheel outside a sphere: 2a — Eqs. (5.3), (5.4)); Eqs. [28]

2

2

where S is a parameter. Here the formulas [28] for (ext and £ext are approximate (in particular, due to the assumption of the authors about the coincidence of (pln = (ext, see the review in the introduction).

Let us consider the numerical example from [28] (Fig. 19). The generatrices of the rollers for moving on the plane, constructed according to formulas (5.1), (5.2) and the equations from [28], coincide. But similar results for the Mecanum wheel on a sphere differ (by less than 1 mm, i.e., less than 5% of the central cross-section radius).

Conflict of interest

The author declares that he has no conflict of interest.

References

[1] Ilon, B. E., Wheels for a Course Stable Selfpropelling Vehicle Movable in Any Desired Direction on the Ground or Some Other Base: Patent Sweden B60B 19/12 (20060101); B60b 019/00, REF/3876255 (Nov 13, 1972).

[2] Taheri, H. and Zhao, C.X., Omnidirectional Mobile Robots, Mechanisms and Navigation Approaches, Mech. Mach. Theory, 2020, vol. 153, no. 2, 103958, 28 pp.

[3] Xie, L., Scheifele, C., Xu, W., and Stol, K.A., Heavy-Duty Omni-Directional Mecanum-Wheeled Robot for Autonomous Navigation: System Development and Simulation Realization, in IEEE Internat. Conf. on Mechatronics (Nagoya, Japan, 2015), pp. 256-261.

[4] Li, Y., Dai, S., Zheng, Y., Tian, F., and Yan, X., Modeling and Kinematics Simulation of a Mecanum Wheel Platform in RecurDyn, J. Robot., 2018, vol. 2018, Art. ID 9373580, 7 pp.

[5] Adascalitei, F. and Doroftei, I., Practical Applications for Mobile Robots Based on Mecanum Wheels: A Systematic Survey, Rev. Precis. Mech. Opt. Mechatron., 2011, vol. 40, pp. 21-29.

[6] Kilin, A. A., Karavaev, Yu. L., and Klekovkin, A. V., Kinematic Control of a High Manoeuvrable Mobile Spherical Robot with Internal Omni-Wheeled Platform, Nelin. Dinam., 2014, vol. 10, no. 1, pp. 113-126 (Russian).

[7] Kilin, A. A. and Karavaev, Yu.L., The Kinematic Control Model for a Spherical Robot with an Unbalanced Internal Omniwheel Platform, Nelin. Dinam., 2014, vol. 10, no. 4, pp. 497-511 (Russian).

[8] Karavaev, Yu. L. and Kilin, A. A., The Dynamics and Control of a Spherical Robot with an Internal Omniwheel Platform, Regul. Chaotic Dyn, 2015, vol. 20, no. 2, pp. 134-152.

[9] Borisov, A.V., Mamaev, I.S., Kilin, A.A., and Karavaev, Yu.L., Spherical Robots: Mechanics and Control, in Proc. of the 4th Internat. School-Conf. for Young Scientists "Nonlinear Dynamics of Machines" (Moscow, Russia, Apr 2017), pp. 477-482 (Russian).

[10] Plumpton, J. J., Hayes, M.J.D., Langlois, R. G., and Burlton, B.V., Atlas Motion Platform Mecanum Wheel Jacobian in the Velocity and Static Force Domains, Trans. Can. Soc. Mech. Eng., 2014, vol. 38, no. 2, pp. 251-261.

[11] Gollner, M., Zhang, J., and Liu-Henke, X., Model Predictive Trajectory Control for Automated Driving of a Spherical Electrical Drive, in Proc. of the IEEE Internat. Systems Engineering Symp. (ISSE, Rome, Italy, 2018), 6 pp.

[12] Huang, Y., Zhu, G., Wang, C., and Huang, H., Structure Design and Dynamical Modelling of a Spherical Robot Driven by Omnidirectional Wheels, MATEC Web Conf., 2018, vol. 153, 02003, 7 pp.

[13] Agullo, J., Cardona, S., and Vivancos, J., Kinematics of Vehicles with Directional Sliding Wheels, Mech. Mach. Theory, 1987, vol. 22, no. 4, pp. 295-301.

[14] Muir, P. and Neuman, C.P., Kinematic Modeling for Feedback Control of an Omnidirectional Wheeled Mobile Robot, in Proc. of the IEEE Internat. Conf. on Robotics and Automation (Raleigh, N.C., 1987): Vol. 4, pp. 1772-1778.

[15] Borisov, A. V., Kilin, A. A., and Mamaev, I.S., An Omni-Wheel Vehicle on a Plane and a Sphere, Nelin. Dinam, 2011, vol. 7, no. 4, pp. 785-801 (Russian).

[16] Zobova, A. A., Application of Laconic Forms of the Equations of Motion in the Dynamics of Non-holonomic Mobile Robots, Nelin. Dinam., 2011, vol. 7, no. 4, pp. 771-783 (Russian).

[17] Hendzel, Z. and Rykala, £., Description of Kinematics of a Wheeled Mobile Robot with Mecanum Wheels, Modelowanie Inzynierskie, 2015, no. 26 (57), pp. 5-12 (Polish).

[18] Adamov, B.I., A Study of the Controlled Motion of a Four-Wheeled Mecanum Platform, Russian J. Nonlinear Dyn, 2018, vol. 14, no. 2, pp. 265-290.

[19] Wampfler, G., Salecker, M., and Wittenburg, J., Kinematics, Dynamics, and Control of Omnidirectional Vehicles with Mecanum Wheels, Mech. Struct. Mach, 1989, vol. 17, no. 2, pp. 165-177.

[20] Gfrerrer, A., Geometry and Kinematics of the Mecanum Wheel, Comput. Aided Geom. Des, 2008, vol. 25, no. 9, pp. 784-791.

[21] Adamov, B. I., Influence of Mecanum Wheels Construction on Accuracy of the Omnidirectional Platform Navigation (on Example of KUKA youBot Robot), in Proc. of the 25th Ann. Saint Petersburg Internat. Conf. on Integrated Navigation Systems, 2018, pp. 251-254.

[22] Adamov, B.I. and Saypulaev, G.R., Research on the Dynamics of an Omnidirectional Platform Taking into Account Real Design of Mecanum Wheels (As Exemplified by KUKA youBot), Russian J. Nonlinear Dyn., 2020, vol. 16, no. 2, pp. 291-307.

[23] Bayar, G. and Ozturk, S., Investigation of the Effects of Contact Forces Acting on Rollers of a Mecanum Wheeled Robot, Mechatronics, 2020, vol. 72, 102467, 13 p.

[24] Shin, D.H. and Lee, I.-T., Geometry Design of Omni-Directional Mecanum Wheel, J. Korean Soc. Precis. Eng., 1998, vol. 15, no. 3, pp. 11-17.

[25] Doroftei, I., Grosu, V., and Spinu, V. Omnidirectional Mobile Robot: Design and Implementation, in Bioinspiration and Robotics Walking and Climbing Robots, M.K.Habib (Ed.), Vienna: I-Tech, 2007, pp. 511-528.

[26] Bae, J.-J. and Kang, N., Design Optimization of a Mecanum Wheel to Reduce Vertical Vibrations by the Consideration of Equivalent Stiffness, Shock. Vib, 2016, vol. 2016, Art. ID 5892784, 8 pp.

[27] Xie, Y., Kang, S.H., Wang, A.R., and Yang, C.Y., Derivation and Simulation on the Academic Profile of the Mecanum Wheel, Adv. Mat. Res., 2012, vols. 546-547, pp. 125-130.

[28] Gollner, M. and Liu-Henke, X., Mathematical Derivation of the Geometry of a Mecanum-Wheel for a Size Exact Roll Off on a Spherical Surface, in Proc. of the 10th Internat. Conf. on Mechatronic Systems and Materials (MSM, Opole, Poland, Jul 2014), 7 pp.

[29] Kosenko, I.I. and Gerasimov, K.V., Physically Oriented Simulation of the Omnivehicle Dynamics, Nelin. Dinam., 2016, vol. 12, no. 2, pp. 251-262 (Russian).

[30] Gerasimov, K. V. and Zobova, A. A., On the Motion of a Symmetrical Vehicle with Omniwheels with Massive Rollers, Mech. Solids, 2018, vol. 53, suppl. 2, pp. 32-42; see also: Prikl. Mat. Mekh., 2018, vol. 82, no. 4, pp. 427-440.

[31] Kosenko, 1.1., Stepanov, S.Ya., and Gerasimov, K.V., Contact Tracking Algorithms in Case of the Omni-Directional Wheel Rolling on the Horizontal Surface, Multibody Syst. Dyn., 2019, vol. 45, no. 3, pp. 273-292.

[32] http://www.youbot-store.com (2014).

i Надоели баннеры? Вы всегда можете отключить рекламу.