Dynamics of tripod drive with elastic self-sustaining transmission
I. A. Nesmiyanov^{1} , V. V. Zhoga^{2} , N. S. Vorobieva^{3} , V. V. Dyashkin-Titov^{4}
^{1, 3, 4}Volgograd State Agrarian University, Volgograd, Russia
^{2}Volgograd State Technical University, Volgograd, Russia
^{2}Corresponding author
Vibroengineering PROCEDIA, Vol. 8, 2016, p. 512-516.
Received 7 September 2016; accepted 12 September 2016; published 7 October 2016
The article describes a mathematical model of dynamics of electromechanical drive with elastic transmission gear. A motor is connected to the tripod actuating links by self-sustaining transmission. The analytical conditions of drive dynamic seizure absence have been obtained.
Keywords: tripod, electric drive, worm reducer, self-sustaining, elasticity, dynamic seizure.
1. Introduction
The tripod shown in Fig. 1 is designed to carry out handling operations. The tripod mechanism includes three controlled actuating links 1, 2, 3 ends of which are fixed with the help of special two-movable hinges on a swiveling base 5. Opposite ends of the links are connected with a special hinge joint 6 allowing geometric axis of these links to cross in one point that prevents bending moments from external loads from appearing in them. The handled item is attached to a rigid suspension which is fastened to a joint 6 [1] via cylindrical hinge.
Tripod design is reinforced that ensures high accuracy of program motions [2]. However, deformations in drive mechanisms can have a significant impact on parameters of dynamic accuracy and dynamic loads values.
Fig. 1. Tripod on a swiveling base
Fig. 2. Design model of a tripod on a swiveling base
1.1. Tripod dynamics
To simplify the differential equations describing the tripod dynamics the real mechanism is replaced with dynamically equivalent one which contains two lumped masses: $m$ in a grip attachment point (point $M$) and ${m}_{A}$ in point $A$ of a swiveling base (Fig. 2) [3].
In this case a differential equations system describing tripod motion established through Lagrange`s equations of the second kind [4] is written as follows:
$m\ddot{y}={F}_{1}\frac{y+OA\cdot \mathrm{s}\mathrm{i}\mathrm{n}\phi}{{l}_{1}}+{F}_{2}\frac{y}{{l}_{2}}+{F}_{3}\frac{y}{{l}_{3}},$
$m\ddot{z}={F}_{1}\frac{z-OA\cdot \mathrm{c}\mathrm{o}\mathrm{s}\phi}{{l}_{1}}+{F}_{2}\frac{z}{{l}_{2}}+{F}_{3}\frac{z}{{l}_{3}}-mg,$
$\ddot{\varphi}\cdot {m}_{A}O{A}^{2}={F}_{1}\frac{OA(y\cdot \mathrm{c}\mathrm{o}\mathrm{s}\varphi +z\cdot \mathrm{s}\mathrm{i}\mathrm{n}\varphi )}{{l}_{1}}+{F}_{4}\frac{OA(DK\cdot \mathrm{s}\mathrm{i}\mathrm{n}\varphi -OK\cdot \mathrm{c}\mathrm{o}\mathrm{s}\varphi )}{{l}_{4}}+{m}_{A}gOA\mathrm{s}\mathrm{i}\mathrm{n}\varphi .$
where Cartesian coordinates of point $M$ (Fig. 2) $x\left(t\right)$, $y\left(t\right)$, $z\left(t\right)$ in absolute coordinates system $Oxyz$ (Fig. 2) and base rotation angle φ were taken as generalized coordinates of the tripod; ${F}_{k}$, $k=$1,…,4 – drive control force in tripod links.
Length of actuating links ${l}_{k}\left(t\right)$, $k=$ 1,…,4 are expressed in terms of generalized coordinates of the tripod as follows [5, 6]:
${l}_{2}\left(t\right)=\sqrt{(x-OB{)}^{2}+{y}^{2}+{z}^{2}},$
${l}_{3}\left(t\right)=\sqrt{(x+OB{)}^{2}+{y}^{2}+{z}^{2}},$
${l}_{4}\left(t\right)=\sqrt{(OK-\mathrm{\u041e}\mathrm{\u0410}\cdot \mathrm{s}\mathrm{i}\mathrm{n}\varphi {)}^{2}+(OA\cdot \mathrm{c}\mathrm{o}\mathrm{s}\varphi +DK{)}^{2}}.$
Geometrical parameters $OA$, $OB$, $OK$, $DK$ of the tripod base and points of its attachment on a swiveling base are shown on Fig. 2.
1.2. Drive dynamics
Each actuating link of the tripod (Fig. 3) consists of separately excited DC electric motor, irreversible worm reducer and screw gear.
Fig. 3. Structural diagram of a driving mechanism of the tripod actuating link; 1 – rod; 2 – program controller; 3 – electric motor; 4 – worm reducer; 5 – screw gear; 6 – feedback transmitter; 7 – feedback controller
Mechanism of motion transmission from a motor to moved mass is considered to be a three-mass system consisting of an electric motor rotor with a worm, worm wheel $c/w$ a screw and a nut with a rod. In this case a model has three degrees of freedom. As generalized coordinates $k$ of a drive the following is selected: rotation angle ${\alpha}_{1k}$ of an output motor shaft (worm), rotation angle ${\alpha}_{2k}$ of a worm wheel and rotation angle ${\alpha}_{3k}$_{}of a screw at the inlet of a slave cylinder nut. Due to transmission yielding they differ by the value of angular deformation.
Dynamic characteristic of a separately excited DC drive motor is written as [7]:
where ${T}_{k}$_{}– motor shaft torque; $\tau $ – electromagnetic time constant; $r$, $s$ – motor parameters-dependent coefficients; ${u}_{k}\left(t\right)$ – control voltage; ${\omega}_{1k}$ – angular velocity to a motor shaft.
Differential equations of rotational motion of a worm with electric motor rotor, a worm wheel with an electro cylinder screw of and forward motion of a nut with an actuating link rod are written as:
where ${I}_{1}$, ${I}_{2}$ – inertia moments of a worm with a rotor and a worm wheel with a screw; ${\dot{\omega}}_{1k}$, ${\dot{\omega}}_{2k}$ – angular acceleration of an electric motor rotor and a worm wheel; ${T}_{1k}$, ${T}_{2k}$ – torques applied to a worm and to a reducer worm wheel; ${T}_{c1}$, ${T}_{c2}$ – constant torques of resistance forces applied to a worm and a worm wheel shaft; $\eta $ – reducer efficiency factor; $i$ – gear ratio of a worm reducer; ${c}_{1\phi}$ – unit stiffness of elastic linkage between motor shaft and worm wheel; ${c}_{2\phi}$ – screw rigidity in torsion; ${m}_{3}$ – mass of a nut with an actuating link rod; ${F}_{k}^{ax}$ – axial moving force; ${F}_{k}$ – rod force determined by load when tripod is in operation Eq. (2).
In case of a lead worm ${c}_{1\varphi}\left({\alpha}_{1k}/i-{\alpha}_{2k}\right)>0$ and efficiency factor equals to $\eta =\mathrm{t}\mathrm{g}{\beta}_{1}/\mathrm{t}\mathrm{g}({\beta}_{1}+{\rho}_{1})$. Here ${\beta}_{1}$ – ascending angle of worm screw line; ${\rho}_{1}$ – modified friction angle. If ${c}_{1\varphi}({\alpha}_{1k}/i-{\alpha}_{2k})<0$, motion is impossible due to reducer irreversibility. In this case dynamic seizure in mechanical transmission will occur [8].
Torque on a guide rotating screw is connected to axial force acting on a nut with a rod by the expression:
where ${\beta}_{3}$, ${\rho}_{3}$ – ascending angle of a screw line and modified friction angle respectively; ${d}_{3}$ – average diameter of screw thread.
Angular screw speed is connected to linear speed of actuating link motion by the relation:
From the system consisting of 32 algebraic and differential Eq. (1-8) based on the laws of control voltage variation ${u}_{k}\left(t\right)$ in energizing winding of drive electric motors and initial conditions 32 unknown functions can be found: generalized coordinates of the tripod $x$, $y$, $z$, $\phi $, length of actuating links ${l}_{k}\left(t\right)$, force in these links ${F}_{k}$_{}and ${F}_{k}^{ax}$, as well as electric motor shaft torque moments ${T}_{k}$ and angular coordinates ${\alpha}_{1k}$, ${\alpha}_{2k}$, ${\alpha}_{3k}$, ($k=$ 1-4).
Torque moment on an electric motor shaft can be calculated via simultaneous solution of Eq. (4-8):
$\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}\mathrm{}+\frac{0.45{d}_{3}\mathrm{t}\mathrm{g}({\beta}_{3}+{\varphi}_{3})}{i\eta}{F}_{k}+\frac{0.45{d}_{3}\mathrm{t}\mathrm{g}({\beta}_{3}+{\varphi}_{3}){I}_{2}}{{c}_{2\varphi}i\eta}{\ddot{F}}_{k}+{T}_{c1}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}{\omega}_{1k}+\frac{{T}_{c2}}{i\eta}\mathrm{s}\mathrm{i}\mathrm{g}\mathrm{n}{\omega}_{2k}.$
Given program motion equations ${l}_{k}^{pr}\left(t\right)$ and introducing dynamic error $\psi ={l}_{k}\left(t\right)-{l}_{k}^{pr}\left(t\right)$, allows for going over to a disturbed motion equation.
No-dynamic seizure conditions are obtained from Eq. (4):
Therefore, expression Eq. (9) determines a permissible value of electric motor shaft torque. When there is a violation of conditions Eqs. (10, 11) dynamic seizure will occur in transmission that can entail unstable operation of a drive and even its malfunction.
1.3. Simulation results
In order to determine model parameters experimental and numerical research were conducted to study dependence of tripod grip motion in plane $yOz$ when one (the first) slave cylinder is in operation while the control voltage was varied according to rectangular waveform ${u}_{1}\left(t\right)=\mathrm{c}\mathrm{o}\mathrm{n}\mathrm{s}\mathrm{t}$, ${t}_{1}>t\ge 0$, ${u}_{1}\left(t\right)=0$, $t\ge {t}_{1}$ For out of service actuating links worm rotation angle ${\alpha}_{1k}$ was taken as zero and warm shaft torque was taken as ${T}_{k}={c}_{1\phi}{\alpha}_{2k}$. Grip load amounts to 420 N. In the process of calculations, the no-dynamic seizure conditions were monitored. A tripod control system is equipped with current sensor ACS712 designed for measuring electric drive current consumption proportional to torque developed by an electric motor [9].
In Fig. 4 presents experimental and theoretical dependences of the moment equivalent ${T}_{1}\left(t\right)$, on an electric motor shaft for two modes of tripod grip motion, namely the first cylinder extension (curve 1, 2), the first cylinder retraction (curve 3, 4), as well as experimental dependence of the first cylinder stroke length change while extending (curve 5) and retracting (curve 6).
Fig. 4. Dependence of torque equivalent developed by electric motor of tripod actuating link drive: 1, 3 – experimental curves, 2, 4 – theoretical and experimental dependence of change of the first link stroke length at extending (curve 5) and retracting (curve 6)
2. Conclusions
The developed mathematical model of tripod dynamics allows for solving the issues regarding determination of electric motors torques required to perform program motions and dynamic loads in kinematic pairs of the tripod, as well as for determining dynamic errors caused by influence transmission elasticity and mechanism dynamic exert on electric motor operation.
Acknowledgements
The work is completed under financial support from the Russian Foundation for Basic Research (RFBR) (Contract No. 15-01-04577-а, No. 16-48-340395 р-а and No. 16-38-00485).
References
- Zhoga V., Gavrilov A., Gerasun V., Nesmianov I., Pavlovsky V., Skakunov V., Bogatyrev V., Golubev D., Dyashkin-Titov V., Vorobieva N. Walking mobile robot with manipulator-tripod. Proceedings of Romansy 20th CISM-IFToMM Symposium on Theory and Practice of Robots and Manipulators, Vol. 22, 2014, p. 463-471. [Search CrossRef]
- Glazunov V. A., Koliskor A. W., Krainev A. F. Spatial Mechanisms of Parallel Structure. Nauka, Moscow, 1991, p. 95, (in Russian). [Search CrossRef]
- Nesmiyanov I., Zhoga V., Skakunov V., Terekhov S., Vorob’eva N., Dyashkin-Titov V., Fares Ali Hussein Al-hadsha Synthesis of control algorithm and computer simulation of robotic manipulator-tripod. Communications in Computer and Information Science, Vol. 535, 2015, p. 392-404. [Search CrossRef]
- Zhoga V., Gerasun V., Nesmiyanov I., Vorob'eva N., Dyashkin-Titov V. Dynamic creation of the optimum program motion of a manipulator-tripod. Journal of Machinery Manufacture and Reliability, Vol. 44, Issue 2, 2015, p. 181-186. [Search CrossRef]
- Kolovskii M. Z., Sloushch A. V. Foundations of Industrial Robot Dynamics. Nauka, Moscow, 1998, (in Russian). [Search CrossRef]
- Korendesev A. I., Salamandra B. L., Tyves L. I. Theoretical Basis of Robotics. Institute of Machines Science named after A.A. Blagonravov of the Russian Academy of Sciences, Nauka, Moscow, Vol. 1, 2006, p. 383, (in Russian). [Search CrossRef]
- Korendesev A. I., Salamandra B. L., Tyves L. I., et al. Manipulation Systems for Robots. Mashinostroenie, Moscow, 1989, p. 427, (in Russian). [Search CrossRef]
- Vejts V. L., Vasil’kov D. V., Gidaspov I. A., Shneerson E. S. Dynamics of Drives of Process Units with Non-Reversible Devices. Monograph in 5 Parts, St. Petersburg, 2002, (in Russian). [Search CrossRef]
- Zhoga V. V., Skakunov V. N., Terehov S. E. Adaptive control system of electric driver walking robot. Journal Izvestiya VSTU, Vol. 157, Issue 2, 2015, p. 180-183, (in Russian). [Search CrossRef]