Cylindrical piezorobot’s trajectory planning and control
Jurate JanutenaiteBogdaniene^{1} , Eugenijus Macerauskas^{2} , Asta Drukteiniene^{3} , Genadijus Kulvietis^{4} , Ramutis Bansevicius^{5}
^{1, 2, 4}Vilnius Gediminas Technical University, Vilnius, Lithuania
^{3}Siauliai University, Siauliai, Lithuania
^{5}Kaunas University of Technology, Kaunas, Lithuania
^{1}Corresponding author
Journal of Vibroengineering, Vol. 19, Issue 4, 2017, p. 26702679.
https://doi.org/10.21595/jve.2017.18147
Received 30 December 2016; received in revised form 21 March 2017; accepted 10 April 2017; published 30 June 2017
JVE Conferences
This paper analyses the movement of piezoelectric actuator. The goal of this work was to create an algorithm for trajectory planning of piezorobot, create a system for trajectory control, develop software and verify the functioning of the algorithm in practice. Movements of piezorobot are very small and very frequent therefore it is difficult to measure trajectories using standard equipment. Design of a novel measurement system and trajectory adjustment was created in this paper. An experimental system for control and trajectory movement tracking of piezorobot was developed. It consists of cylindrical piezorobot, control signal forming and image processing system for trajectory tracking. The cylindrical piezorobot moves in specific trajectories on the plane and is controlled with sinusoidal signals. They are generated by trajectory forming and control software using MATLAB and LabVIEW. The control signals are monitored using a system with oscilloscope. The trajectory of piezorobot was monitored and measured using video camera and video processing software developed by LabVIEW. The software contains image processing and object path tracking, and is implemented using LabVEW and MATLAB. Experimental results showed that trajectories forming algorithm and developed control software is suitable for controlling robots moving on plane.
Keywords: stabilization, piezo, nanosatellite, trajectory control, numerical analysis, trajectory planning.
1. Introduction
High precision, accurate position determination and compactness are the desired features in various modern positioning systems. There are different approaches to meet these requirements such as using gyroscopes or piezoelectric actuators. Gyroscopes are employed in nanosatellites for attitude determination, robot orientation and stabilization [13]. In order to obtain the required accuracy various sensors are integrated in a single system [2]. This is done in order to avoid gyroscope’s accumulated error over longer periods of time. For indoor robots gyroscope and stereo vision data fusion can be used to eliminate unbounded drift error [3]. Errors also occur due to manufacturing imperfections; therefore, it is important to analyze the stability of such constructs in case the symmetry of the structure is destroyed [1]. Often Kalman and extended Kalman filters are used for gyroscope’s measurement data fusion. Various stabilization prototypes have been developed [4] however they are usually too big and cannot be implemented in compact and low cost systems.
Piezoelectric actuators are small, easily incorporated into systems and relatively cheap. Nevertheless, they too do not guarantee that no errors will occur because using voltage input leads to hysteresis and creep [5]. There are various solutions such as using a charge input, inserting a capacitor or developing various monitoring systems [5, 6]. Therefore, it is very important to develop systems that are capable to control the performance of piezoelectric actuators [79]. Self – guided mechanisms allow reaching greater precision and reducing the errors [8]. Choosing the correct eigenform, geometrical parameters and ensuring that the construction works properly is essential for proper operation of piezorobot [8, 10, 11]. Algorithms which are used to control various mobile robots can also be successfully applied to piezorobots [13, 16]. For example, optimized AI based algoritms such as support vector ordinal regression (SVOR) allow effective trajectory movement control [16, 18]. Control systems for mobile robots with feedback use various sensors, like video cameras which can be used to monitor the trajectory of piezorobot [16, 19]. Image processing is done using already developed LabVIEW software or database based image processing algorithms [17, 20]. The goal of this research was to develop a control system that adjusts the movement of piezorobot in real time using data received from image tracking software.
2. FEM analysis
Piezoceramic cylinder with sectioned electrodes is made of PZT4 material. In order to determine the correct geometrical parameters modal analysis was carried out. Modal and harmonic analyses were done using ANSYS software. For piezorobot to move in the required motion the cylinder must either stretch or compress in $Z$ direction and such movement must be dominant compared to deformations that occur in $X$ or $Y$ directions. In order to determine if such eigenform exists it was assumed that no displacements in $X$ or $Y$ direction are possible. Although such assumptions describe ideal conditions they are satisfactory for determining whether the required form exists or not. Modal analysis showed that the required form exists for cylinder with geometric parameters 33 mm (outer diameter) × 28 mm (inner diameter) × 21 mm (height). The results are presented in Fig. 1. Results of FEM analysis showed that the structure is compressed and the suitable eigenform is at 91 kHz (Fig. 1(a)) thus proving that the required form exists (Fig. 1(b)).
There are three inner electrodes each 120 degrees. Voltage is applied at one electrode at a time and outer electrode is grounded. The amplitudes of contact points are determined by voltage. The working voltage is at 100 V. Harmonic analysis results are shown in Fig. 2.
Fig. 1. Modal analysis results
a) Displaced structure with undeformed edge
b) Harmonic analysis results, $Z$ component of displacement
Fig. 2. Electrodes scheme and contacts points of cylindrical piezorobot
When voltage is applied, the cylinder deforms in a suitable form and contact points create the required motion for piezorobot (Fig. 2).
3. Mathematical model for contact excitation duration for nonrotational robot
A piezorobot consisting of three segments ($c=\text{3}$) is analyzed. Movement is created by exciting one of the segments therefore the robot moves from one trajectory point to another without any rotation (Fig. 3).
Fig. 3. Structure of piezorobot’s control and path verification system
Movement trajectory is calculated using contact switching algorithm which is explained in detail in source [12]. This algorithm gives information about movement points (${x}_{ri},{y}_{ri}$) of a robot, distance between the coordinates ${d}_{i}$ and the number of segment which should be excited using a force $\overrightarrow{F}$. Direction of $\overrightarrow{F}$ coincides with the displacement direction ${d}_{i}$ and value is constant throughout the movement. Excitation force $\overrightarrow{F}$ should affect the segment ${J}_{i}$ for duration of ${t}_{i}$ until the required destination is reached or required distance is travelled.
It is known that:
where $a$ – acceleration of piezorobot, ${v}_{0i}=\text{0}$ – velocity at the beginning, ${v}_{i}$ – velocity after time${t}_{i}$, ${t}_{i}$ – movement time, $i=$ 1, 2,….
Time can be derived from Eq. (1) as follows:
When active segment number $J$ and coordinates $({x}_{r},{y}_{r})$ are known, it is possible to calculate displacement between coordinates as shown in Fig. 3 [12]:
Displacement can expressed using piezorobot‘s velocity $v$ and acceleration $a$:
Acceleration can be expressed as follows:
where $M$ – mass of piezorobot, $\left\overrightarrow{F}\right$ – excitation force of a segment,
Time which takes the piezorobot to move from coordinates $({x}_{rl},{y}_{rl})$ to ${(x}_{rl+1},{y}_{rl+1})$ can be expressed through velocity $v$:
When the segment is active, time ${t}_{i}$ can be expressed as:
Excitation time algorithm is shown in Fig. 4. $\alpha $ – orientation angle of robot in respect of $x$ axis (the first symmetry axis of segment angle in respect of $x$ axis). ${\epsilon}_{max}$ – maximum possible movement trajectory error from planned trajectory, $S$ – planned movement trajectory [12].
Algorithm calculates duration of excitation $t$ for specific segment $J$.
Fig. 4. General active segment time calculating algorithm
4. Experimental investigation of contact excitation duration for nonrotational robot
An experimental system for control of piezorobot and trajectory movement tracking was created. It consists of cylindrical piezorobot, control signal formation and image processing system for trajectory tracking of piezorobot. Control system is presented in Fig. 8.
Fig. 8. The structure of the piezorobot control and path verification system
Piezorobot is moving on a glass plate. The control signal of piezorobot was amplified using high voltage amplifier and interface to hardware output was set according to the technical requirements of National Instruments NIDAQmx hardware [14, 15]. Signals are monitored using a system with oscilloscope and object tracking is implemented using video camera with LabVIEW based image processing software. The experimental system is shown in Fig. 9.
Fig. 9. Computer based experimental system
The control software of piezorobot is based on LabVIEW and designed to operate on industry PXI (PCI eXtensions for InstrumentationNI PXIe1062Q) computer system. Image tracking subsystem is based on LabVIEW as well and works with high resolution industry camera (Basler Scout SCA 160014 gm).
Piezoelectric cylinder type piezorobot used in practical experiments is presented in Fig. 10 and function diagram of expriment system is shown in Fig. 11.
Fig. 10. Electrode segments of piezorobot and topology of contact points
a) Top view of piezorobot. Where 1, 2, 3, segments of electrode, 4 – orientation arrow)
b) Bottom view of piezorobot. Where 1, 2, 3 – contact points
Fig. 11. Control of piezorobot and trajectory tracking system block diagram
The trajectories planning module software is based on MATLAB and is used to calculate the trajectories of piezorobot [12]. Analog signal control sequence for control of piezorobot was formed using signals formation and distribution system. Analog output hardware DAQ (Data Acquisition NI PXIe1062) is a physical equipment that distributes the analog signals to the physical outputs. Piezorobot moves on glass surface using high voltage (up to 160 V_{p}_{p}) sinusoidal signal therefore analog amplifier is needed.
Trajectory planning software was integrated into the LabVIEW software with MATLAB module (M) forms a sinusoidal frequency control signal (f) for three sinusoidal signal generators G1, G2 and G3. They create sinusoidal 52.5 kHz signal for the control of piezorobot. Amplitude control signals (g1, g2, g3) change the amplitude of each signal at the right time and manage the amplifiers A1, A2 and A3. Each segment of piezorobot (1, 2 and 3) receive an enhanced signal and individually manages the amplitudes according to algorithm given by mathematical module M. The mathematical module calculates variables’ values according to given piezorobot’s algorithm.
Hardware control software is based on LabVIEW and uses MATLAB script as a mathematical module (Fig. 12). The trajectory speed was set manually using real time clock that was set in milliseconds with external multiplication. Three channel sine wave generator was created with LabVIEW and controlled using MATLAB script. The same script generates path data for trajectory monitoring.
Trajectory monitoring part consists of industrial video camera VC and image processing software. The software is designed for visual tracking with image grabber IG. Object tracker (OT) is designed to track piezorobot and create an array of path coordinates (CA). Movement of piezorobot is observed in real time through Image and Object module and trajectory path graph is generated. Path trajectory monitoring module simultaneously receives theoretical coordinates from MATLAB script module.
Fig. 12. Piezorobot’s control and path monitoring software LabVIEW block diagram
5. Experimental results
According to Eq. (4) MATLAB module generates control signal sequence in real time. Control signal of each segment in both experiments (when ${\epsilon}_{max}$ – ±1 mm and ${\epsilon}_{max}$ – ±3 mm) lasts for a specific time interval as shown in Table 1.
Control signal generation for each segment of piezorobot is done using the algorithm presented in Fig. 13. The generated control signal is distributed to three segments with contact points. Physical control signal is received with DAQmx analog output and is monitored with oscilloscope. Diagrams of signal distribution to segments are shown in oscillogram (Fig. 14) and the path of the piezorobot is presented in Fig. 15.
In order to validate theoretical algorithms video camera was tracking movement trajectory of piezorobot. Image processing algorithms and coordinate tracking methods are not discussed in detail because they are standard for NI Vision package. Coordinate tracking methods are similar to those presented in [20], however overall algorithm build in NI Vision software is less complex and more universal.
Coordinates were obtained with LabVIEW and presented using MATLAB (Fig. 16).
Table 1. Specific time interval of control signal
The experiment with ${\epsilon}_{max}$ – ±1 mm

The experiment with ${\epsilon}_{max}$ – ±3 mm


$i$

$J$

$d$, mm

${C}_{1}$, $\u2206t$, $s$

${C}_{2}$, $\u2206t$, $s$

${C}_{3}$, $\u2206t$, $s$

$i$

$J$

$d$, mm

${C}_{1}$, $\u2206t$, $s$

${C}_{2}$, $\u2206t$, $s$

${C}_{3}$, $\u2206t$, $s$

3

1

14,688

1,851

9

1

4,545

3,597


4

3

8,348

4,438

10

3

1,604

1,935


5

1

20

6,831

11

1

6,417

3,869


6

2

13,75

5,664

13

2

4,011

3,059


7

1

7,188

4,095

13

1

4,813

3,351


8

2

6,875

4,005

14

2

3,743

2,955


9

1

9,063

4,598

15

1

1,604

1,935


Where $i$ – step number, $J$ – segment number, $d$ – distance in mm that piezorobot travels in one step, $t$ – time elapsed from the beginning of experiment, ${c}_{1}$, ${c}_{2}$, ${c}_{3}$, $\u2206t$, $s$ – time when segments c_{1}, ${c}_{2}$ and ${c}_{3}$ are active

Fig. 13. Segments’ control algorithm
Fig. 14. Electrical signals on segments of piezorobot. T0 – start time, T1,…, T6 time from start to control signal end of each segment
Fig. 15. Object tracking and path plotting window. 1 – Tracking point on piezorobot, 2 – path of piezorobot, 3 – path plotting window
Fig. 16. Trajectories of piezorobot obtained during the experiment. Here ${\epsilon}_{max}$ – calculated error, ${\epsilon}_{max}^{\text{'}}$ – measured error
a) Calculated error ${\epsilon}_{max}$ – ±1 mm
b) Calculated error $\epsilon {\u2019}_{max}$ – ±3 mm
The results showed that when calculated error ${\epsilon}_{max}$ is estimated to be ±1 mm, measured error ${\epsilon}_{max}^{\text{'}}$ aquires values ±1.36 mm and when ${\epsilon}_{max}$_{}is ±3 mm, measured error is $\epsilon {\u2019}_{max}$ ±4.6 mm.
Percentage error:
where $\u2206{y}_{max}$ – calculated $y$ coordinate error, $\u2206{y}_{max}^{\text{'}}$ – mesured $y$ coordinate error. Percentage errors calculated by the Eq. (5): when ${\epsilon}_{max}^{\text{'}}$±1 mm: –26 %, and when ${\epsilon}_{max}^{\text{'}}$±3 mm –53.33 %.
When ${\epsilon}_{max}$±1 mm (Fig. 16(a)) the error is smaller due to smaller formation step. In case when ${\epsilon}_{max}$±3 mm (Fig. 16(a)) the step is rougher which leads to bigger error. If errors are predicted using probabilities and the step is chosen then both methods give similar errors.
6. Conclusions
A new trajectory planning method was proposed and evaluated. Motion of the piezorobot is formed using new segments excitation scheme when two or more segments are excited to obtain linear motion without rotation. Trajectory planning method was validated using special experimental system.
1) Piezorobot moves in required trajectory with acceptable accuracy;
2) Experimental trajectory is similar to theoretical therefore this method can be applied for control of piezorobot.
3) The accuracy of trajectory depends on chosen error therefore it is important to optimize the algoritm by chosing optimal number of steps;
4) Calculated error ${\epsilon}_{max}^{\text{'}}$ reaches maximum value only where trajectory bends. This happens because generated force vector is not aligned with movement direction. It is necessary to rotate piezorobot at a different angle at bending points. If such adjustments are made then the discussed method is suitable when piezorobot rotates [12].
Acknowledgements
This research is funded by Research Council of Lithuania, Project No. MIP084/2015.
References
 Xiang X., Yulie W., Xiaomei W., Yi T., Xuezhong W. Investigation on standing wave vibration of the imperfect resonant shell for cylindrical gyro. Sensors and Actuators A: Physical, Vol. 179, 2012, p. 7077. [Publisher]
 Shaobo N., Cui Zhang Attitude determination of nano satellite based on gyroscope, sun sensor and magnetometer. Procedia Engineering, Vol. 15, 2011, p. 959963. [Publisher]
 Ahmad K., Christof H., Hubert R. Data fusion of stereo vision and gyroscope for estimation of indoor mobile robot orientation. IFAC Proceedings Volumes, Vol. 45, Issue 4, 2012, p. 163168. [Search CrossRef]
 Votrubec R. Stabilization of platform using gyroscope. Procedia Engineering Vol. 69, 2014, p. 410414. [Publisher]
 Minase J., Lu T., Cazzolato B., Grainger S. A review, supported by experimental results, of voltage, charge and capacitor insertion method for driving piezoelectric actuators. Precision Engineering, Vol. 34, Issue 4, 2010, p. 692700. [Publisher]
 Gozen Arda B., Ozdoganlar Burak O. Characterization of threedimensional dynamics of piezostack actuators. Mechanical Systems and Signal Processing, Vol. 31, 2012, p. 268283. [Publisher]
 Kima J. J., Choib J. M., Ahna D., Beomseok B., Gweona D. G., Jeongf J. A millimeterrange flexurebased nanopositioning stage using a selfguided displacement amplification mechanism. Mechanism and Machine Theory, Vol. 50, 2012, p. 109120. [Publisher]
 Grybas I., Bansevičius R., Bubulis A., Jūrėnas V., Janutėnaitė J., Kulvietis G. R&D of high resolution rotary table based on the ultrasonic standing waves. Vibroengineering Procedia, Vol. 3, 2014, p. 5558. [Search CrossRef]
 Zheng J., Salton A., Fu M. Design and control of a rotary dualstage actuator positioning system. Mechatronics, Vol. 21, Issue 6, 2011, p. 10031012. [Publisher]
 Bansevičius R., Kulvietis G., Janutėnaitė J., Rybokas M. Analysis of cylindrical piezoelectric actuator used in 3DOF deflectors. Proceedings of the 7th International Conference on Engineering Mechanics, Structures, Engineering Geology, 2014, p. 8691. [Search CrossRef]
 Alijani F., Amabili M. Nonlinear vibrations of shells: a literature review from 2003 to 2013. International Journal of NonLinear Mechanics. Vol. 58, 2014, p. 233257. [Publisher]
 Drukteiniene A. Trajectories’ Formation for Mobile Multidimensional Piezorobots with Nanometer Resolution. Doctoral Dissertation, Technika, 2011. [Search CrossRef]
 Bansevicius R., Drukteiniene A., Kulvietis G., Mazeika D. Switching leg method for trajectory planning of mobile piezorobot. Journal of Vibroengineering, Vol. 12, Issue 1, 2010, p. 2633. [Search CrossRef]
 Shujiao J., Yanmin L., Wanli Z. The design of data acquisition system based on virtual instrument. ICCSNT, 2nd International Conference, 2012. [Search CrossRef]
 Sumathi S., Surekha P. LabVIEW Based Advanced Instrumentation Systems. Springer, Berlin Heidelberg, New York, 2007. [Search CrossRef]
 Aboshosha A. Adaptive Navigation and Motion Planning for Autonomous Mobile Robots. Doctoral Dissertation, der Fakultät für Informations und Kognitionswissenschaften der EberhardKarlsUniversität, Tübingen, 2004, p. 6684. [Search CrossRef]
 Xuezhi W., Ling, Yu X., Wei F. A rapid learning algorithm for vehicle classification. Information Sciences, Vol. 295, Issue 1, 2015, p. 395406. [Search CrossRef]
 Gu B., Sheng V., Tay K., Romano W., Li S. Incremental support vector learning for ordinal regression. IEEE Transactions on Neural Networks and Learning Systems, Vol. 26, Issue 7, 2015, p. 14031416. [Publisher]
 Xia Z., Wang X., Sun X., Liu Q., Xiong N. Steganalysis of LSB matching using differences between nonadjacent pixels. Multimedia Tools and Applications, Vol. 75, Issue 4, 2016, p. 19471962. [Publisher]
 NI Vision Concepts Manual North Mopac Expressway Austin. Texas 787593504, National Instruments Inc., USA 2004. [Search CrossRef]
Cited By
Micromachines
Ramutis Bansevicius, Jurate JanutenaiteBogdaniene, Vytautas Jurenas, Genadijus Kulvietis, Dalius Mazeika, Asta Drukteiniene

2018
