
Citation: Jinhua Zhou, Shan Jia, Jinbao Chen, Meng Chen. Motion and trajectory planning modeling for mobile landing mechanism systems based on improved genetic algorithm[J]. Mathematical Biosciences and Engineering, 2021, 18(1): 231-252. doi: 10.3934/mbe.2021012
[1] | Wenyang Gan, Lixia Su, Zhenzhong Chu . A PSO-enhanced Gauss pseudospectral method to solve trajectory planning for autonomous underwater vehicles. Mathematical Biosciences and Engineering, 2023, 20(7): 11713-11731. doi: 10.3934/mbe.2023521 |
[2] | Junjie Liu, Hui Wang, Xue Li, Kai Chen, Chaoyu Li . Robotic arm trajectory optimization based on multiverse algorithm. Mathematical Biosciences and Engineering, 2023, 20(2): 2776-2792. doi: 10.3934/mbe.2023130 |
[3] | Chengjun Wang, Xingyu Yao, Fan Ding, Zhipeng Yu . A trajectory planning method for a casting sorting robotic arm based on a nature-inspired Genghis Khan shark optimized algorithm. Mathematical Biosciences and Engineering, 2024, 21(2): 3364-3390. doi: 10.3934/mbe.2024149 |
[4] | Su-na Zhao, Yingxue Cui, Yan He, Zhendong He, Zhihua Diao, Fang Peng, Chao Cheng . Teleoperation control of a wheeled mobile robot based on Brain-machine Interface. Mathematical Biosciences and Engineering, 2023, 20(2): 3638-3660. doi: 10.3934/mbe.2023170 |
[5] | Juan Du, Jie Hou, Heyang Wang, Zhi Chen . Application of an improved whale optimization algorithm in time-optimal trajectory planning for manipulators. Mathematical Biosciences and Engineering, 2023, 20(9): 16304-16329. doi: 10.3934/mbe.2023728 |
[6] | Zhiqiang Wang, Jinzhu Peng, Shuai Ding . A Bio-inspired trajectory planning method for robotic manipulators based on improved bacteria foraging optimization algorithm and tau theory. Mathematical Biosciences and Engineering, 2022, 19(1): 643-662. doi: 10.3934/mbe.2022029 |
[7] | Yuzhuo Shi, Huijie Zhang, Zhisheng Li, Kun Hao, Yonglei Liu, Lu Zhao . Path planning for mobile robots in complex environments based on improved ant colony algorithm. Mathematical Biosciences and Engineering, 2023, 20(9): 15568-15602. doi: 10.3934/mbe.2023695 |
[8] | Zhen Yang, Junli Li, Liwei Yang, Qian Wang, Ping Li, Guofeng Xia . Path planning and collision avoidance methods for distributed multi-robot systems in complex dynamic environments. Mathematical Biosciences and Engineering, 2023, 20(1): 145-178. doi: 10.3934/mbe.2023008 |
[9] | Xiaoyong Xiong, Haitao Min, Yuanbin Yu, Pengyu Wang . Application improvement of A* algorithm in intelligent vehicle trajectory planning. Mathematical Biosciences and Engineering, 2021, 18(1): 1-21. doi: 10.3934/mbe.2021001 |
[10] | Baoye Song, Shumin Tang, Yao Li . A new path planning strategy integrating improved ACO and DWA algorithms for mobile robots in dynamic environments. Mathematical Biosciences and Engineering, 2024, 21(2): 2189-2211. doi: 10.3934/mbe.2024096 |
Lander and rover played a vital role in landing exploration, in previous missions [1], many different types of landers and rovers were launched onto the surface of the moon and other planets. Nowadays, with the increasing requirements of landing detection technology, the lander also needs to have more functions. In the past few decades, many important models have been developed, such as Luna 16 [2,3], Euro Moon 2000 [4], Altair Lander [5], The Insight Mars Lander [6], Chang e 4 [7], etc.. Most of them have four legs, each of which consists of a main buffer mechanism, an auxiliary buffer mechanism and a foot pad, can be folded and then unfolded, and absorbs shock on impact. However, it is not possible of them to realize functions like attitude adjustment and walking (or moving). Therefore, detection tasks, though very limited, cannot be accomplished without the aid of rover.
In order to expand the detection range of the extra-terrestrial galaxies’ surface, some movable rovers with wheeled mechanisms have been developed, such as Sojourner rover [8], Mars Rover mission [9] Spirit and Opportunity rovers, Jade Rabbit rover [10] and so on. However, most wheeled rovers have limited ability to travel through complex and harsh terrain environments, and even basic functions like moving and adjusting directions are impossible.
The rover must be carried to the surface of the extra-terrestrial galaxies by the lander before the subsequent detection mission, which has some limitations [11,12,13,14]: (1) The explore range of motion of the rover is very limited. The rover cannot reach remote destinations remote from the landing site since they have to receive energy and other supplies from the lander after extravehicular activity, which means, even both lander and rover can keep working without damage, it is still impossible of the rover to explore areas beyond a certain safe range. (2) As the exploration mission became more complex, it will be a great challenge for the wheeled rover to pass through rough terrains full of obstacles and slopes.
To solve problems above, a novel legged mobile landing mechanism is in urgent need. At present, some configurations of the legged mobile lander have been proposed. However, they are still in stages of conception, and no in-depth study on their walking characteristics and trajectory planning is ever conducted. One key issue of designing such a lander is to design the structure of its leg, which should bear high payload and have high reliability at the same time. To cope with such demands, the parallel configuration is considered to be a good choice. Parallel mechanisms have been widely used in aircraft simulators, force/torque sensors and acceleration sensors [15,16]. In recent years, parallel mechanisms that both maintain the inherent advantages of parallel mechanisms and possess several other advantages in terms of the total cost reduction in manufacturing and wider workspace (the Delta robot [17], and Tricept robot and Trivariant robot [18]), are drawing increasing attention of researchers. Combined with the traditional parallel robot configuration features, and combine parallel robots with traditional lander configurations, such as PH-Robot [19], Prototypes of Octopus robot [20], and so on.
A novel design for the kinematic control structure of the wheeled mobile robot (WMR) path planning and path-following was presented [21]. A mobile robot path planning method in the visualize plane using an overhead camera based on interval type-2 fuzzy logic (IT2FIS) was proposed. It is necessary to determine the location of a mobile robot in an environment surrounding the robot [22]. The Mem-PBPF algorithm yields improved performance in terms of time execution by using a parallel implementation on a multi-core computer was proposed. Therefore, the Mem-PBPF algorithm achieves high performance yielding competitive results for autonomous mobile robot navigation in complex and real scenarios [23]. A novel proposal makes use of the Artificial Potential Field (APF) method with a Bacterial Evolutionary Algorithm (BEA) to obtain an enhanced flexible path planner method taking all the advantages of using the APF method, strongly reducing its disadvantages [24]. A navigation software called Ant Colony Test Center designed to teach the different stages involved in mobile robotics was presented [25]. A novel proposal to solve the problem of path planning for mobile robots based on Simple Ant Colony Optimization Meta-Heuristic (SACO-MH) was presented [26].
In this paper, we focus on type synthesis of an innovative legged mobile lander combining characteristics and capabilities of both the lander and the rover inspired by the configurations of existing landers and walking robots. The MLM works as a landing buffer during landing. After that, it has 3 working modes: in mode 1, the stationary legged mobile lander works as a base camp; in mode 2, it performs exploratory tasks using its legs, which can be seen as a legged rover; while in mode 3, the MLM adjust its attitude to prepare for launching.
The purpose of designing the MLM is to ensure that the lander has good motion stability and environmental adaptation. One of the difficulties in lander motion control is to optimize the foot motion trajectory of the MLM [27,28]. Researchers have made achievements on the problem. (Y-sway and E-sway motions [29,30], a sinusoidal sway [31] and the trajectory planning method based on the quantic spline curve [32]). However, few attentions have been paid to methods of foot trajectory planning for quadruped parallel robots. When performing a walking task, the leg structure will inevitably produce an obvious mechanical vibration, which will greatly jeopardize the walking stability of the whole machine. To solve such problems, by taking characteristics of configuration and motion into consideration, a method of trajectory planning for the foot is proposed.
At present, the research direction in the field of robot research mainly dedicated to the study of trajectory planning, under certain conditions this also to solve nonlinear constrained optimization problem provides a new train of thought Liu et al. [33] proposed a time optimal rapid continuous motion constraints, robot trajectory planning method in order to solve the problem of the optimal trajectory planning of robot, Xu et al. [34] put forward a kind of environment - genetic evolution immune clone algorithm Liu et al. [35] weighting coefficient method is used to establish the industrial robot trajectory planning model, and puts forward an improved adaptive genetic algorithm to solve Saramago and Steffen [36] solved the problem of manipulator moving at the minimum cost on the specified geometric path. Since the working environment of MLM studied in this paper is different from that of industrial robots, not only efficiency but also stability should be considered. The acceleration of impact force can be effectively controlled by controlling impact.
This paper is organized as follows, after discussing the structure configuration in sections Ⅰ, the kinematics of the MLM is studied and analyzed in section Ⅱ. The optimal time-jerk trajectory planning method is proposed in section Ⅲ. Simulation and experiment results and discussions are presented in section Ⅳ. Finally, conclusions are given in section Ⅴ.
In this paper, the MLM is a parallel mechanism, as shown in Figure 1(a), R, U, P, and S denote revolute, universal, prismatic and spherical joint respectively. P pair is the actuated joint driven by an actuator. The MLM’s structure includes: main body, swinging limb, RPR limb, upper leg, UPS limb-1, UPS limb-2, ball joint mounting bracket and foot. One end of the swinging limb is connected to the main body by a revolute joint, and the other connected to the upper leg by a Hooke joint. The middle position of the swinging limb is connected with the RPR limb by a revolute joint. The other end of the RPR limb is connected to the main body by a revolute joint, and the linear actuator installed on the RPR limb provides power for the swing rod installed on the body to swing up and down. The ball joint bearing is installed at the lower end of the upper leg. The two UPS limbs are of the same structure, whose one end is connected to the main body by a Hook joint, and the other connected to the ball joint mounting bracket on the upper leg by a ball joint. The middle part is the linear actuator.
The MLM is composed of three groups of buffer-drive mechanism, as shown in Figure 1(b). The buffer drive mechanism is mainly composed of the outer tube, compression tube, internal buffer materials, external buffer materials, piston rod, locking mechanism, screw drive mechanism, step motor and reset spring. Due to the complexity of landing environment, buffer-drive mechanism may be stretched or compressed during landing impact. When compressed, the internal buffer material is compressed by the piston rod. When stretched, the external buffer material is compressed by the piston rod through the locking mechanism and the outer tube. Since the compression length of the external buffer material does not affect the motion performance of MLM, only the compressed state of the internal buffer material is considered. Before compression, the initial distance of the internal buffer material is v1. Piston rod can move distance is v2. After compression, buffer material compression distance is Δv. At this point, the piston rod can move distance is Δv+v2. Internal critical compression of the buffer to the distance is Δv=0 and Δv=v1. Therefore, in order to ensure the safety and feasibility of MLM mechanism. v2 is used as the input conditions of the workspace.
Figure 2 shows the schematic diagram of the MLM, which can be decomposed into eight isolated rigid bodies. Ui (i = 1, 2, 3) denotes the center of the U joint. si(i = 2, 3) denotes the center of the S joint. A denotes the end point of the upper leg. The point OS is the intersection of the upper leg and the normal plane on which points OS, s2 and s3 are located. ΔR0U2U3 and ΔOsS2S3 are isosceles triangles. Frame R0−x0y0z0 is fixed on the main body, while z0 axis coincides with the first rotational axis of R0, R0 axis is parallel to both, R1 axis and R2 axis. z2axis and z3 axis intersect at origin U1 and are perpendicular to each other. At Os, ,the upper leg is perpendicular to the plane where ΔOsS2S3 lies limb U2P2S2 is connected to s2 on ΔOsS2S3. Similarly, limb U3P3S3 is connected to S3 on ΔOSS2S3. B1 denotes the distance between point R0 and U1. B2 denotes the distance between point O4 O4 and U1, and d denotes the distance between the tip A and point O4. L1 ≡ ⇀R2R1, L2≡ ⇀U2S2 and L3 ≡ ⇀U3S3 are defined as components in the base frame R0−x0y0z0.
Firstly, as usual, the relationship between the position of point OS at the tip and the position of the MLM should be derived to implement trajectory tracking. The three limbs in the MLM are R0U1OSA, U2P2S2 and U3P3S3. Firstly, the frames are established at each revolute joint position of the limb R0U1OSA by the D-H method [37]. We can obtain the transformation matrix between adjacent link-fixed frames between frames R0−x0y0z0 and OS−x4y4z4, as follows:
i−1Ti=[ii−1R0ii−1P1] | (1) |
where,
ii−1R=[cosθisinθi0−sinθicosωi−1cosθicosωi−1sinωi−1sinθisinωi−1−cosθisinωi−1cosωi−1] | (2) |
i−1iP=[di−1cosθidi−1sinθiai] | (3) |
ai is the distance from zi to zi+1 along the xi, wi is the rotation angle from zi to zi+1 around xi, θi is the rotation angle from xi−1 to xi around zi, di is the distance from xi−1 to xi along the zi.
We solve the kinematic equations as follows. In deriving the kinematic equations for the MLM, we formed the transformation matrix between frame R0 and OS:
0T4=0T11T22T33T4=(C1C2C3−S1S3−C3S1−C1C2S3−C1S2−B2(S1S3−C1C2C3)C1S3+C2C3S1C1C3−C2S1S3−S1S2B2(C1S3+C2C3S1)−B1C1C3S2−S2S3C2B2C3S20001) | (4) |
Where Si and Ci (i = 1, 2, 3) denote sin θi和cos θi, respectively. Then, the position vector of tip A in frame R0−x0y0z0 can be derived,
0TA=(0xA0yA0zA)=(B1S1−(B2+d)(S1S3−C1C2C3)(B2+d)(C1S3+C2C3S1)−B1C1(B2+d)C3S2) | (5) |
From Figure 3 and Eq (5), the following equation is obtained,
{θ1=−arcsin(Ax2+Ay2+Az2−(B2+d)22B1√Ax2+Ay2)+arctan(AyAx)θ2=arctan(−2B1Az√4B12+(Ax2+Ay2)−(Ax2+Ay2+Az2+B12−(B2+d)2)2)θ3=π−arcsin((B2+d)2−(Ax2+Ay2+Az2)2B1(B2+d) | (6) |
L1=√h2+b2−2hbcos(θ1+π2−δ) | (7) |
From the geometrical relationship and Figure 2, we obtained:
{[L20]=0T4[1PS21]−[0PU21][L30]=0T4[1PS31]−[0PU31] | (8) |
Where,
0PU2=[0−ay−az],0PU3=[0−ayaz],0PS2=[0−by−bz],0PS3=[0−bybz]. |
It can be derived from Eqs (5)–(8).
{L2=[by(C3S1+C1C2C3)−B2(S1S3−C1C2C3)+B1S1+bzC1S2ay+B2(C1S3+C2C3S1)−by(C1C3−C2S1S3)−B1C1+bzS1S2az−bzC2+B2C3S2+byS2S3]L3=[by(C3S1+C1C2C3)−B2(S1S3−C1C2C3)+B1S1−bzC1S2ay+B2(C1S3+C2C3S1)−by(C1C3−C2S1S3)−B1C1−bzS1S2bzC2−az−bzC2+B2C3S2+byS2S3] | (9) |
Thus, the displacements of L2 and L3 can be represented as:
{L2=√LT2L2L3=√LT3L3 | (10) |
The size and shape of the reachable workspace of the foot end is constrained by the following factors: (1) length of the limb; (2) limitation of universal joint. The constraints can be expressed as follows:
{Limin<Li<Limaxθi<θimax | (11) |
where θi is real angle of the universal joint; θimax is the allowable maximal angle of the universal joint; Limin is the minimum of the limb length; Limax is the maximum of the limb length.
Table 1 shows parameters of dimension and kinematic pairs of the MLM.
No. | Parameter | Value |
1 | L1/mm | 600 ~ 960 |
2 | L2/mm | 580 ~ 780 |
3 | L3/mm | 580 ~ 780 |
4 | {{\rm{ \mathsf{ θ} }}_1}/° | −5 ~ 30 |
5 | {{\rm{ \mathsf{ θ} }}_2}/° | −20 ~ 20 |
6 | {{\rm{ \mathsf{ θ} }}_3}/° | −60 ~ −90 |
7 | {{\rm{B}}_1}/mm | 500 |
8 | {{\rm{B}}_2}/mm | 2093 |
9 | \mathrm{d} /mm | 500 |
Referring to the constraints in Table 1, the reachable workspace of the foot end can be solved by Monte Carlo method [38], as shown in Figure 4.
In Figure 4 it can be found that the value and fluctuate for the foot end is smaller when the reachable workspace is in the ranges x ∈ [−50 ~ 2800] mm, y ∈ [−3200 ~ −750] mm, z ∈ [−1100 ~ 1100] mm, which is reasonably large to walk. Therefore, this area can be chosen as the optimal motion workspace of the leg mechanism.
With the mechanism meeting requirements of walking, its mobility stability becomes particularly important since the lander works in a complex working environment, which requires the end motion trajectory of the mechanism to be optimized.
Joint trajectories of the MLM can be obtained by polynomial or cubic spline method. Those generated by cubic splines have continuous accelerations, comparing with the higher order polynomial method, cubic splines overcome problems like over-oscillation and overshoot between pairs of reference points. The knots in the path of the motion joint in Cartesian space are mapped to joint space [39]. Meanwhile, the cubic spline curve was used to interpolate the knots of each motor joint. We obtained a cubic polynomial that satisfies the following conditions.
\begin{array}{l} {G_{ji}}(t) = \frac{{{{\ddot G}_{ji}}({t_i})}}{{6{h_i}}}{({t_{i + 1}} - t)^3} + \frac{{{{\ddot G}_{ji}}({t_{i + 1}})}}{{6{h_i}}}{(t - {t_i})^3} + \\ (\frac{{{g_{ji + 1}}}}{{{h_i}}} - \frac{{{h_i}{{\ddot G}_{ji}}({t_{i + 1}})}}{6})(t - {t_i}) + (\frac{{{g_{ji}}}}{{{h_i}}} - \frac{{{h_i}{{\ddot G}_{ji}}({t_i})}}{6})({t_{i + 1}} - t) \\ \end{array} | (12) |
\begin{array}{l} {{\dot G}_{ji}}(t) = \frac{{{{\ddot G}_{ji}}({t_i})}}{{2{h_i}}}{({t_{i + 1}} - t)^2} + \frac{{{{\ddot G}_{ji}}({t_{i + 1}})}}{{6{h_i}}}{(t - {t_i})^2} + \\ (\frac{{{g_{ji + 1}}}}{{{h_i}}} - \frac{{{h_i}{{\ddot G}_{ji}}({t_{i + 1}})}}{6}) + (\frac{{{g_{ji}}}}{{{h_i}}} - \frac{{{h_i}{{\ddot G}_{ji}}({t_i})}}{6}) \\ \end{array} | (13) |
{\ddot G_{ji}}(t) = \frac{{{t_{i + 1}} - t}}{{{h_i}}}{\ddot G_{ji}}({t_i}) + \frac{{t - {t_i}}}{{{h_i}}}{\ddot G_{ji}}({t_i}_{ + 1}) | (14) |
{\dddot G_{ji}}(t) = \frac{{{{\ddot G}_{ji}}({t_i}_{ + 1}) - {{\ddot G}_{ji}}({t_i})}}{{{h_i}}} | (15) |
In Eqs (12)–(15), {h_i} = {t_{i + 1}} - {t_i}, t \in \left[{{t_i}, {t_{i + 1}}} \right], {g_{ji}}, {v_{ji}}, {a_{ji}}, i = 1, 2, \cdots n - 1, denote the displacement, instantaneous velocity and instantaneous acceleration of ith key node in {j_{th}} joint, of which {v_{j1}}, {a_{j1}} and {v_{jn}} {a_j}_n, are given, j = 1, 2, \cdots, N, {\rm{i = }}1, 2, \cdots, n; \left\{ {{t_1}, {t_2}, \cdots, {t_n}} \right\} is the time series of the movement of the MLM to each key point. We also define {G}_{ji}\left(t\right), {\dot{G}}_{ji}\left(t\right), {\ddot{G}}_{ji}\left(t\right) \mathrm{ } and {\dddot G_{ji}}\left(t \right) as the displacement, velocity, acceleration and quadratic acceleration in the time interval \left[{{t_i}, {t_{i + 1}}} \right] of joint {j} .
The motion of MLM actuators is constrained by velocity, accelerator and the second accelerator.
\left| {{{\dot G}_{ji}}\left( t \right)} \right| - {{\rm{V}}_{jm}} \leqslant 0 | (16) |
With {\dot G_{ji}}\left(t \right) being quadratic (13), its maximum can be denoted as Max \left[{{{\dot G}_{ji}}({t_1}), {{\dot G}_{ji}}({t_{i + 1}}), {{\dot G}_{ji}}({t_i})} \right], that is
{\rm Max}\left[ {\left| {{{\dot G}_{ji}}({t_1})} \right|, \left| {{{\dot G}_{ji}}({t_{i + 1}})} \right|, \left| {{{\dot G}_{ji}}({t_i})} \right|} \right] - {V_{jm}} \leqslant 0 | (17) |
\left|{\ddot{G}}_{ji}\left(t\right)\right|-{\rm{A}}_{jm}\le 0 | (18) |
we then obtain:
Max
\left[ {\left| {{{\ddot G}_{ji}}({t_i})} \right|, \left| {{{\dot G}_{ji}}({t_i}_{ + 1})} \right|} \right] - {A_{jm}} \leqslant 0 | (19) |
\left[{\left| {{{\dddot G}_{ji}}({t_i})} \right|} \right] - {J_{jm}} \leqslant 0 | (20) |
We notice that quadratic acceleration in Eq (15) is not continuous, namely, there are jerks when the MLM’s end moves form the initial position to some desired final position.
Jerks not only accelerate the wear and tear of the parts, but also increase the end-effector positioning errors. As a result, the stability of the whole machine is reduced. In order to make the manipulator satisfied a certain work efficiency, and to ensure the movement is relatively stable, we established a time-jerk optimal trajectory planning model with respect to the total operation time and the square of the jerk for the components, that is:
{\rm{min}}\left[{W}_{T}N\sum\limits _{i = 1}^{n-1}{\rm{h}}_{i}+{W}_{J}\sum\limits_{j = 1}^{N}\sum\limits_{i = 1}^{n-1}\left(\frac{{\left[{\ddot{G}}_{ji}\left({t}_{i+1}\right)-{\ddot{G}}_{ji}\left({t}_{i}\right)\right]}^{2}}{{\rm{h}}_{i}}\right)\right] | (21) |
Where {W_T} denotes the weight of time, {W_J} denotes the weight of jerk, and {W_T} + {W_J} = 1. The values of the weights {W_T} and {W_J} can be chosen to obtain the minimum time-jerk trajectory to some extent. By choosing {W_J} = 0 a minimum-time trajectory is found, while setting {W_T} = 0 enables one to obtain a minimum-jerk trajectory.
In order to optimize the Eq (21), we first map the optimized search space to search space of the genetic algorithm (GA), then the optimization parameter and the fitness function was determined. In order to make the optimization problem of objective function conforms to the operation rules of GA. Finally, the optimal objective function value is obtained by time segments. AGA not only can not consider specific meaning of parameters and their complicated relationship, the algorithm can deal with complicated problems, especially some issues of value concept has stronger global searching ability, at the same time as a result of the parallel search method, makes the genetic algorithm has a faster search at the same time also can apply to most, solving nonlinear large peak of discontinuous function more for function optimization problems show no expression can also apply. An adaptive fitness function is adopted in this paper, which can be automatically adjusted individual fitness gap according to the changes of the individual living environment, making the algorithm converges to its optimal solution. Thus, the blindness of the initial optimization can be greatly reduced, the amount of computation can be saved, and the real-time performance of the algorithm can be improved.
In this paper, the model of minimum time-jerk trajectory planning is presented with cubic splines connected the points. However, this model has the characteristics of complex coupling relationship and strong nonlinearity, so if traditional genetic algorithm is used, it is easy to fall into the local optimal solution. An adaptive fitness function is adopted in this paper, which can be automatically adjusted individual fitness gap according to the changes of the individual living environment, making the algorithm converges to its optimal solution. Thus, the blindness of the initial optimization can be greatly reduced, the amount of computation can be saved, and the real-time performance of the algorithm can be improved.
Specific implementation steps:
A small population with less evolutionary algebra was set up, the local optimal velocity can be obtained quickly. The landing leg structure first runs along the trajectory according to this optimal velocity.
Expand the population and increase the evolutionary algebra so that the global optimal velocity is obtained, ultimately ensuring that the landing leg structure runs at the optimal velocity trajectory.
The individual is selected by the individual's fitness degree, the roulette model is established, and the elite with the smallest probability value is directly replaced and copied to the next generation with the elite selection probability {p_s} [40].
Crossover and mutation probability affect the individual diversity, robustness and convergence of GA. The sigmoid function of neural network was introduced into GA as an adaptive function of crossover probability and mutation probability, as shown in Eqs (22) and (23).
{u_c} = \left\{ {\begin{array}{*{20}{l}} {\frac{{{u_{c\max }} - {u_{c\min }}}}{{1 + \exp \left( {A\frac{{2(f* - {f_{avg}})}}{{{f_{\max }} - {f_{avg}}}}} \;\;\right)}},\;\;\;\;f* - {f_{avg}} \ge 0,}&{}\\ {{{\rm{u}}_{{\rm{cmax}}}},\;f* - {f_{avg}} \lt 0}&{} \end{array}} \right. | (22) |
{u_m} = \left\{ {\begin{array}{*{20}{l}} {\frac{{{u_{m\max }} - {u_{m\min }}}}{{1 + \exp \left( {9.903438\frac{{2(f* - {f_{avg}})}}{{{f_{\max }} - {f_{avg}}}}} \;\;\right)}},\;\;\;f* - {f_{avg}} \ge 0,}&{}\\ {{{\rm{u}}_{{\rm{cmax}}}},\;\;f* - {f_{avg}} \lt 0}&{} \end{array}} \right. | (23) |
Where {u_c} denotes the crossover probability; {u_m} denotes the mutation probability, ; {u_{c\max }} denotes the upper limit of crossover probability contemporary populations; {u_{c\min }} denotes the lower limit of crossover probability; f* denotes the value of higher fitness of the two selected individuals; f denotes the fitness value of mutating individual; {f_{avg}} denotes the average value of contemporary populations; {f_{\max }} denotes the maximum fitness value of contemporary population; {u_{c\max }} denotes the upper limit of crossover probability contemporary populations; {u_{mmax}} denotes the upper limit of mutation probability; {u_{m\min }} denotes the lower limit of mutation probability.
Eqs (22) and (23) suggested that when the individual fitness values of the population tend to be consistent, larger {u_m} and {u_c} are needed. Whereas the population individual fitness values are dispersed, the smaller {u_m} and {u_c} are selected. The flow chart of the adaptive genetic algorithm (AGA) is shown in Figure 5.
Considering the constraints of landing leg structure parameters and motion parameters, we chose a safe workspace for the simulation experiment. in the ranges x ∈ (1000 ~ 2000 mm), y ∈ (−3000 ~ −2000 mm) and z ∈ (−400 ~ 400 mm). Based on the kinematics equation obtained in part 2, under the premise of displacement, velocity and acceleration of the joint space, the AGA program is designed.
Based on the weighted coefficient method, an optimal time-jerk pedestal trajectory planning model is established. By adjusting different weighting coefficients, the minimum parameters of time and jerk are obtained. The limits of Kinematic Limits are expressed in Table 3, and the displacement of knots in joint space are reported in Table 4. By using the genetic algorithm (GA) for the optimal solution, we obtained the optimal trajectories in various {W_T} and {W_J}. As shown in Figure 6, we set the trajectory of the end-effector of the MLM with respect to the inertial reference frame A - XYZ as follows:
Parameter | Value | Parameter | Value |
population size | 50 | Cross probability {u_{c\min }} | 0.8 |
maximum number of generations | 600 | Mutation probability {u_{mmax}} | 0.2 |
Cross probability {u_{c\max }} | 0.99 | Mutation probability {u_{m\min }} | 0.05 |
Constraint | Joint | ||
1 | 2 | 3 | |
Velocity/(deg/s) | 400 | 380 | 380 |
Acceleration/(deg/s2) | 200 | 180 | 180 |
Jerk/(deg/s3) | 100 | 90 | 90 |
Knots /deg | Joint | ||
1 | 2 | 3 | |
g1 | 15.2102 | −16.9058 | −14.758 |
g2 | Virtual point | Virtual point | Virtual point |
g3 | 12.6982 | −13.3764 | −6.8201 |
g4 | 9.307 | −8.8297 | 1.6705 |
g5 | 5.2752 | −3.6047 | 10.0103 |
g6 | 0.8918 | 1.9217 | 17.4333 |
g7 | −3.4917 | 7.25968 | 23.3867 |
g8 | −7.6867 | 11.9948 | 27.4687 |
g9 | −11.4045 | 15.7754 | 29.5034 |
g10 | −14.444 | 18.3502 | 29.4909 |
g11 | −16.5415 | 19.6062 | 27.6194 |
g12 | −17.5212 | 19.5057 | 24.0775 |
g13 | −17.1444 | 18.1618 | 19.1414 |
Aiming at the motion characteristics of the active joint of the MLM, the time-jerk motion trajectory planning problem is proposed in this paper. By setting its weight parameter, the time-jerk mobility parameter in its motion process is optimized. Firstly, simulation analysis was carried out for two states, {\mathrm{W}}_{T} = 1 and {\mathrm{W}}_{T} = 0 . It can be found from Figures 7 and 8 that when {\mathrm{W}}_{T} = 1, the trajectory planning time was less than 4.5 s, and the maximum jerk was 1000 deg/{s}^{3} .When {\mathrm{W}}_{T} = 0 and {\mathrm{W}}_{J} = 0 , the simulation time is 6 s and the maximum jerk degree is 68 deg/{s}^{3}. Therefore, we need to find a good set of weight parameters so as to optimize the motion trajectory of the driving joint.
Table 5 shows that the shortest execution time is 2.9885 s, and as the time weighted coefficient values ({W_T}) decrease, the execution time of the MLM increase, and jerks of actuators decrease. That is to say, the reduction of the jerk is at the expense of the execution efficiency. When the value of {W_T} is less than 0.999999, the total value of maximum jerks of joints does not significantly decrease as exaction time increases. And when {W_T} is less than 0.9993, the total time taken to complete the motion trajectory by the MLM will be more than 5 s, which cannot meet the design requirements. When {W_T} = 0.999995 and {W_J} = 0.000005, the optimal solution is obtained at a certain extent. The results of the simulations are reported in Figures 9 and 10.
Parameter | Weight | |||||||||
{W_T} | 0 | 0.9999 | 0.99999 | 0.999993 | 0.999995 | 0.999999 | 0.9999993 | 0.9999995 | 0.9999999 | 1 |
{W_J} | 1 | 0.0001 | 0.00001 | 0.000007 | 0.000005 | 0.000001 | 0.0000097 | 0.0000005 | 0.0000001 | 0 |
h1/s | 0.6895 | 0.5237 | 0.4923 | 0.4077 | 0.3636 | 0.2280 | 0.3071 | 0.3035 | 0.2114 | 0.2418 |
h2/s | 0.6751 | 0.4432 | 0.3989 | 0.4267 | 0.3191 | 0.4687 | 0.3345 | 0.3438 | 0.2524 | 0.2096 |
h3/s | 0.6436 | 0.4758 | 0.3564 | 0.4078 | 0.3177 | 0.5041 | 0.3041 | 0.2955 | 0.3396 | 0.2456 |
h4/s | 0.5616 | 0.5045 | 0.3440 | 0.4342 | 0.3460 | 0.4956 | 0.3985 | 0.3276 | 0.2648 | 0.3534 |
h5/s | 0.5439 | 0.5671 | 0.4442 | 0.4231 | 0.3148 | 0.3607 | 0.3807 | 0.3877 | 0.3253 | 0.1002 |
h6/s | 0.5418 | 0.5636 | 0.4803 | 0.4363 | 0.3091 | 0.2937 | 0.3051 | 0.3808 | 0.2937 | 0.3269 |
h7/s | 0.4944 | 0.5098 | 0.3753 | 0.3980 | 0.3611 | 0.2710 | 0.4055 | 0.3192 | 0.2650 | 0.1699 |
h8/s | 0.6682 | 0.5053 | 0.4480 | 0.3968 | 0.3082 | 0.2635 | 0.3280 | 0.3406 | 0.2150 | 0.3597 |
h9/s | 0.6866 | 0.4408 | 0.5232 | 0.3425 | 0.3595 | 0.2364 | 0.3029 | 0.3233 | 0.2625 | 0.1181 |
h10/s | 0.6658 | 0.3565 | 0.3052 | 0.3344 | 0.3911 | 0.2460 | 0.3029 | 0.2986 | 0.2813 | 0.2749 |
h11/s | 0.5310 | 0.5236 | 0.2794 | 0.3448 | 0.3895 | 0.3448 | 0.3308 | 0.3078 | 0.2626 | 0.1813 |
h9/s | 0.8855 | 0.5927 | 0.3653 | 0.3674 | 0.3241 | 0.3714 | 0.3153 | 0.2651 | 0.2694 | 0.2019 |
h10/s | 0.8473 | 0.3004 | 0.4102 | 0.4171 | 0.4553 | 0.3442 | 0.3532 | 0.3571 | 0.2512 | 0.2051 |
∑hi | 8.4343 | 6.3069 | 5.2227 | 5.1368 | 4.5591 | 4.4282 | 4.3687 | 4.2504 | 3.4944 | 2.9885 |
{J_{1\max }} | 7.8279 | 31.4263 | 80.6735 | 69.6688 | 81.161 | 190.0436 | 204.8789 | 253.3385 | 552.7644 | 732.5254 |
{J_{2\max }} | 5.9946 | 27.9385 | 82.6640 | 77.1002 | 84.0519 | 214.9931 | 238.5967 | 301.8268 | 548.4399 | 814.6972 |
{J_{3\max }} | 40.9249 | 82.6025 | 129.6890 | 152.0706 | 138.8546 | 270.9026 | 296.1057 | 340.8264 | 575.4084 | 602.4032 |
∑{J_i} | 54.7474 | 141.9673 | 293.0265 | 298.8396 | 304.0675 | 675.9392 | 739.5813 | 895.9917 | 1676.6127 | 2149.6259 |
Note:{h_i} for the time intervals in seconds, {J_{1\max }}, {J_{2\max }} and {J_{3\max }} for the absolute values of maximum jerk of the joints 1–3, respectively, {J_i} for the total value of jerks (absolute values) of each joint. |
The convergence of the algorithm is shown in Figure 11.
It can be found from Figure 11 and Table 6 that the algorithm has a fast convergence speed, which is suitable for solving the optimal time-jerk problem and meeting the actual demand. In the experiment, in order to verify the effectiveness of the algorithm, GA and AGA were used to solve the optimal trajectory of MLM. The population size of each optimization algorithm was 50, and the number of iterations was 600. By comparing Figures 11 and 12, it is found that the convergence rate of the improved AGA is better than that of GA. And AGA has fewer values of objective function.
![]() |
Converges to the global optimal solution times | Number of times of falling into the local optimal solution | Converges to the global optimal solution least algebra | Mean convergence generations |
AGA | 30 | 0 | 160 | 190 |
GA | 9 | 18 | 240 | 260 |
Table 6 compares the precocity and convergence performance of AGA and GA algorithms. The experiments were repeated 30 times, and the evolution algebra of both algorithms was 600 generations. It can be seen from the Table 6 that AGA has significantly improved its global optimization ability and fast convergence ability.
In this paper, a novel mobile landing mechanism (MLM) is proposed. It realizes functions like landing on the lunar surface and walking in complex terrain environments, and greatly extends features of traditional landers. In order to verify the walking feasibility and reliability of the MLM. Firstly, the monte-Carlo method is used to solve the workspace, and the motion feasibility of the mechanism is verified. Secondly, combining with the constraints of velocity, acceleration and secondary acceleration of each driving joint of the MLM, the trajectory of its joint space is planned by using cubic spline curve. And based on the weighted coefficient method, an optimal time-jerk pedestal trajectory planning model is established. Finally, by comparing the genetic algorithm (GA) with the adaptive genetic algorithm (AGA), an optimization algorithm is proposed to solve the joint trajectory optimization problem of the MLM, which can obtain better trajectory under constraints. Simulation shows that the motion performance of the mechanism is continuous and stable, which proves the rationality and effectiveness of the foot trajectory planning method.
Future work has several directions, such as: (1) as for the working space scope of the lander, further optimization is needed in the future to improve the motion performance of the lander. (2) the designed AGA for the weighted coefficient of time weighted coefficient and shock of optimal experimental method is used to approximate values, only to solve the approximate solution, and the lack of rigorous mathematical deduction, therefore, an optimization algorithm is designed to automatically obtain the global optimal solution of the objective function is a difficult problem to study for the future and goals. (3) The method in this paper can be extended and applied to a variety of series and parallel robots, so as to realize the motion capability of traditional robots.
The authors would like to thank team members in In-orbit control and landing laboratory of Nanjing University of Aeronautics. This work was funded by the National 13th Five-Year Civil Space Program [D030103], the National Natural Science Foundation (51675264) and the Youth Science and Technology Innovation Fund of Nanjing University of Aeronautics and Astronautics (NS2018052).
The authors declare no conflict of interest. The funders had no role in the design of the study; in the collection, analyses, or interpretation of data; in the writing of the manuscript, or in the decision to publish the results.
[1] |
T. Okada, S. Sasaki, T. Sugihara, K. Saiki, H. Akiyama, M. Ohtake, et al., Lander and rover exploration on the lunar surface: A study for SELENE-B mission, Adv. Space Res., 37 (2006), 88-92. doi: 10.1016/j.asr.2005.05.097
![]() |
[2] |
R. J. Williams, E. K. Gibson, The origin and stability of lunar goethite, hematite and magnetite, Earth Planet. Sci. Lett., 17 (1972), 84-88. doi: 10.1016/0012-821X(72)90261-0
![]() |
[3] | T. E. Ford, C. Eng, A. F. R. Ae. S, The Apollo lunar module: a description of the construction of the lunar module used to make the first manned landing of a space vehicle on another planet, Aircraft Eng. Aerosp. Technol., 41 (1969), 26-28. |
[4] |
R. Parkinson, The use of system models in the Euro Moon spacecraft design, Acta Astronaut., 44 (1999), 437-443. doi: 10.1016/S0094-5765(99)00088-0
![]() |
[5] | M. Benton, B. Donahue, D. Bienhoff, G. Caplin, D. Smith, K. Reiley, Configuration Options to Maximize Lunar Surface Reuse of Altair Lander Structure and Systems, AIAA SPACE 2009 Conference & Exposition, 2006. |
[6] |
M. A. Siegler, S. E. Smrekar, M. Grott, S. Piqueux, N. Mueller, J. Pierre, et al., The InSight Mars Lander and Its Effect on the Subsurface Thermal Environment, Space Sci. Rev., 211 (2017), 1-17. doi: 10.1007/s11214-017-0414-0
![]() |
[7] |
P. J. Ye, Z. Z. Sun, H. Zhang, F. Li, An overview of the mission and technical characteristics of change'4 lunar probe, Sci. China Technol. Sci., 60 (2017), 658-667. doi: 10.1007/s11431-016-9034-6
![]() |
[8] | K. Iagnemma, H. Shibly, A. Rzepniewski, S. Dubowsky, P. Territories, Planning and Control Algorithms for Enhanced Rough-Terrain Rover Mobility, International Symposium on Artificial Intelligence, Robotics, and Automation in Space, 2001. |
[9] |
R. Lindemann, D. B. Bickler, B. D. Harrington, G. M. Ortiz, C. J. Voothees, Mars exploration rover mobility development-mechanical mobility hardware design, development, and testing, IEEE Rob. Autom. Mag., 13 (2006), 19-26. doi: 10.1109/MRA.2006.1638012
![]() |
[10] | C. K. Liu, B. F. Wang, J. Wang, G. S. Tang, W. J. Wan, Y. L. Bu, Integrated INS and vision based orientation determination and positioning of CE-3 lunar rover, J. Spacecr. TT & C Technol., 33 (2014), 250-257. |
[11] |
F. Cordes, F. Kirchner, A. Babu, Design and field testing of a rover with an actively articulated suspension system in a Mars analogy terrain, J. Field Robo., 35 (2018), 1149-1181. doi: 10.1002/rob.21808
![]() |
[12] | L. Liang, Z. Zhang, L. Guo, C. Yang, Y. Zeng, M. Li, et al., Mobile Lunar Lander Crewed Lunar Exploration Missions, Man. Spaceflight, 21 (2015), 472-478. |
[13] | R. Zhu, Advances in the Soviet/Russian EVA Spacesuit Technology, Man. Spaceflight, 1 (2009), 25-45. |
[14] | B. Birckenstaedt, J. Hopkins, B. Kutter, F. Zegler, T. Mosher, Lunar Lander Configurations Incorporating Accessibility, Mobility, and Centaur Cryogenic Propulsion Experience, Space, 2006 (2006), 1-12. |
[15] | Q. Liang, D. Zhang, Y. Wang, G. Coppola, Y. Ge, PM based multi-component F/T sensors-State of the art and trends, Robot, Robo. Comput. Integr. Manuf., 29 (2013), 1-7. |
[16] |
T. Hashimoto, T. Hoshino, S. Tanaka, M. Otsuki, H. Otake, H. Morimoto, Japanese moon lander SELENE2-Present status in 2009, Acta Astronaut., 68 (2011), 1386-1391. doi: 10.1016/j.actaastro.2010.08.027
![]() |
[17] |
F. Pierrot, C. Reynaud, A. Fournier, DELTA: a simple and efficient parallel robot, Robotica, 8 (1990), 105-109. doi: 10.1017/S0263574700007669
![]() |
[18] | V. Poppeová, V. Bulej, P. Šindler, Development of simulation software and control system for mechanism with hybrid kinematic structure, ISR 2010 (41st International Symposium on Robotics) and ROBOTIK 2010 (6th German Conference on Robotics), 2010. |
[19] | G. Zhong, H. Deng, G. Xin, H. Wang, Dynamic hybrid control of a hexapod walking robot experimental verification, IEEE Trans. Ind. Electron., 63 (2016), 5001-5011. |
[20] |
P. Yang, F. Gao, Leg kinematic analysis and prototype experiments of walking-operating multifunctional hexapod robot, Proc. Inst. Mech. Eng. Part C, 228 (2014), 2217-2232. doi: 10.1177/0954406213516087
![]() |
[21] |
M. Dirik, A. F Kocamaz, O. Castillo, Global Path Planning and Path-Following for Wheeled Mobile Robot Using a Novel Control Structure Based on a Vision Sensor, Int. J. Fuzzy Syst., 22 (2020), 1880-1890. doi: 10.1007/s40815-020-00888-9
![]() |
[22] | M. Dirik, O. Castillo, A. F. Kocamaz, Visual-Servoing Based Global Path Planning Using Interval Type-2 Fuzzy Logic Control, Axioms, 58 (2019), 1-16. |
[23] |
U. Orozco-Rosas, K. Picos, O. Montiel, Hybrid path planning algorithm based on membrane pseudo-bacterial potential field for autonomous mobile robots, IEEE Access, 7 (2019), 156787-156803. doi: 10.1109/ACCESS.2019.2949835
![]() |
[24] |
O. Montiel, U. Orozco-Rosas, R. Sepúlveda, Path planning for mobile robots using Bacterial Potential Field for avoiding static and dynamic obstacles, Expert Syst. Appl., 42 (2015), 5177-5191. doi: 10.1016/j.eswa.2015.02.033
![]() |
[25] |
O. Montiel-Ross, R. Sepúlveda, O. Castillo, P. Melin, Ant colony test center for planning autonomous mobile robot navigation, Comput. Appl. Eng. Educ., 21 (2013), 214-229. doi: 10.1002/cae.20463
![]() |
[26] |
M. A. Porta Garcia, O. Montiel, O. Castillo, R. Sepúlveda, P. Melin, Path planning for autonomous mobile robot navigation with ant colony optimization and fuzzy cost function evaluation, Appl. Soft Comput., 9 (2009), 1102-1110. doi: 10.1016/j.asoc.2009.02.014
![]() |
[27] |
Y. Pan, F. Gao, A new six-parallel-legged walking robot for drilling holes on the fuselage, Proc. Inst. Mech. Eng., Part C, 228 (2014), 753-764. doi: 10.1177/0954406213489068
![]() |
[28] |
J. T. Yen, Y. H. Chang, Rate-dependent control strategies stabilize limb forces during human locomotion, J. R. Soc. Interface, 7 (2010), 801-810. doi: 10.1098/rsif.2009.0296
![]() |
[29] |
S. K. Banala, S. K. Agrawal, S. H. Kim, J. P. Scholz, Novel gait adaptation and neuromotor training results using an active leg exoskeleton, IEEE-ASME Trans. Mechatron., 15 (2010), 216-225. doi: 10.1109/TMECH.2010.2041245
![]() |
[30] | F. T. Cheng, H. L. Lee, D. E. Orin, Increasing the locomotive stability margin of multilegged vehicles, Proceedings 1999 IEEE International Conference on Robotics and Automation, 1999. |
[31] | D. Pongas, M. Mistry, S. Schaal, A robust quadruped walking gait for traversing rough terrain, Proceedings 2007 IEEE International Conference on Robotics and Automation, 2007. |
[32] |
S. Zhang, X. Rong, Y. Li, B. Li, A composite cog trajectory planning method for the quadruped robot walking on rough terrain, Int. J. Control Autom., 8 (2015), 101-118. doi: 10.14257/ijca.2015.8.9.11
![]() |
[33] |
H. Liu, X. Lai, W. Wu, Time-optimal and jerk-continuous trajectory planning for robot manipulators with kinematic constraints, Robo. Comput. Integr. Manuf., 29 (2013), 309-317. doi: 10.1016/j.rcim.2012.08.002
![]() |
[34] | H. Xu, X. Xie, J. Zhuang, S. Wang, Global Time-energy Optimal Planning of Industrial Robot Trajectories, J. Mech. Eng., 46 (2010), 19-25. |
[35] | F. Liu, L. Fei, Time-jerk optimal planning of industrial robot trajectories, Int. J. Robo. Autom., 31 (2016), 1-7. |
[36] |
S. F. P. Saramago, V. Steffen Jr, Optimization of the Trajectory Planning of Robot Manipulators Taking into Account the Dynamics of the System, Mech. Mach. Theory, 33 (1998), 883-894. doi: 10.1016/S0094-114X(97)00110-9
![]() |
[37] | S. Wen, Z. Ma, S. Wen, Y. Zhao, J. Yao, The study of NAO robot arm based on direct kinematics by using D-H method, 2014 UKACC International Conference on Control (CONTROL), 2014. |
[38] | Y. Guan, K. Yokoi, Reachable Space Generation of A Humanoid Robot Using The Monte Carlo Method, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2006. |
[39] | F. Liu, F. Lin, Time-jerk optimal planning of industrial robot trajectories, Int. J Robo. Autom., 31, (2016), 1-7. |
[40] | J. L. Martínez, J. González, J. Morales, A. Mandow, A. J. García-Cerezo, Mobile robot motion estimation by 2D scan matching with genetic and iterative closest point algorithms, J. Field Robo., 23 (2010), 21-34. |
1. | Jinhua Zhou, Haifeng Ma, Jinbao Chen, Shan Jia, Sukun Tian, Motion characteristics and gait planning methods analysis for the walkable lunar lander to optimize the performances of terrain adaptability, 2023, 132, 12709638, 108030, 10.1016/j.ast.2022.108030 | |
2. | Huixian Wei, Jia Liu, Balakrishnan Nagaraj, Computer Mathematical Modeling Based on the Improved Genetic Algorithm and Mobile Computing, 2021, 2021, 1530-8677, 1, 10.1155/2021/1584435 | |
3. | Jinhua Zhou, Haifeng Ma, Shan Jia, Sukun Tian, Mechanical properties of multilayer combined gradient cellular structure and its application in the WLL, 2023, 24058440, e14825, 10.1016/j.heliyon.2023.e14825 | |
4. | Yanan Fan, Zhongcai Pei, Chen Wang, Meng Li, Zhiyong Tang, Qinghua Liu, A Review of Quadruped Robots: Structure, Control, and Autonomous Motion, 2024, 6, 2640-4567, 10.1002/aisy.202300783 | |
5. | Linyu Liu, Raziah Ahmad, Suriati Ahmad, Xuejie Wang, The application of IGA in urban landscape design optimization, 2024, 36, 1532-0626, 10.1002/cpe.8227 | |
6. | Chuanqin Zheng, Qingshuang Zhuang, Shu-Juan Peng, Efficient motion capture data recovery via relationship-aggregated graph network and temporal pattern reasoning, 2023, 20, 1551-0018, 11313, 10.3934/mbe.2023501 |
No. | Parameter | Value |
1 | {{\rm{L}}_1}/mm | 600 ~ 960 |
2 | {{\rm{L}}_2}/mm | 580 ~ 780 |
3 | {{\rm{L}}_3}/mm | 580 ~ 780 |
4 | {{\rm{ \mathsf{ θ} }}_1}/° | −5 ~ 30 |
5 | {{\rm{ \mathsf{ θ} }}_2}/° | −20 ~ 20 |
6 | {{\rm{ \mathsf{ θ} }}_3}/° | −60 ~ −90 |
7 | {{\rm{B}}_1}/mm | 500 |
8 | {{\rm{B}}_2}/mm | 2093 |
9 | \mathrm{d} /mm | 500 |
Parameter | Value | Parameter | Value |
population size | 50 | Cross probability {u_{c\min }} | 0.8 |
maximum number of generations | 600 | Mutation probability {u_{mmax}} | 0.2 |
Cross probability {u_{c\max }} | 0.99 | Mutation probability {u_{m\min }} | 0.05 |
Constraint | Joint | ||
1 | 2 | 3 | |
Velocity/(deg/s) | 400 | 380 | 380 |
Acceleration/(deg/s2) | 200 | 180 | 180 |
Jerk/(deg/s3) | 100 | 90 | 90 |
Knots /deg | Joint | ||
1 | 2 | 3 | |
g1 | 15.2102 | −16.9058 | −14.758 |
g2 | Virtual point | Virtual point | Virtual point |
g3 | 12.6982 | −13.3764 | −6.8201 |
g4 | 9.307 | −8.8297 | 1.6705 |
g5 | 5.2752 | −3.6047 | 10.0103 |
g6 | 0.8918 | 1.9217 | 17.4333 |
g7 | −3.4917 | 7.25968 | 23.3867 |
g8 | −7.6867 | 11.9948 | 27.4687 |
g9 | −11.4045 | 15.7754 | 29.5034 |
g10 | −14.444 | 18.3502 | 29.4909 |
g11 | −16.5415 | 19.6062 | 27.6194 |
g12 | −17.5212 | 19.5057 | 24.0775 |
g13 | −17.1444 | 18.1618 | 19.1414 |
Parameter | Weight | |||||||||
{W_T} | 0 | 0.9999 | 0.99999 | 0.999993 | 0.999995 | 0.999999 | 0.9999993 | 0.9999995 | 0.9999999 | 1 |
{W_J} | 1 | 0.0001 | 0.00001 | 0.000007 | 0.000005 | 0.000001 | 0.0000097 | 0.0000005 | 0.0000001 | 0 |
h1/s | 0.6895 | 0.5237 | 0.4923 | 0.4077 | 0.3636 | 0.2280 | 0.3071 | 0.3035 | 0.2114 | 0.2418 |
h2/s | 0.6751 | 0.4432 | 0.3989 | 0.4267 | 0.3191 | 0.4687 | 0.3345 | 0.3438 | 0.2524 | 0.2096 |
h3/s | 0.6436 | 0.4758 | 0.3564 | 0.4078 | 0.3177 | 0.5041 | 0.3041 | 0.2955 | 0.3396 | 0.2456 |
h4/s | 0.5616 | 0.5045 | 0.3440 | 0.4342 | 0.3460 | 0.4956 | 0.3985 | 0.3276 | 0.2648 | 0.3534 |
h5/s | 0.5439 | 0.5671 | 0.4442 | 0.4231 | 0.3148 | 0.3607 | 0.3807 | 0.3877 | 0.3253 | 0.1002 |
h6/s | 0.5418 | 0.5636 | 0.4803 | 0.4363 | 0.3091 | 0.2937 | 0.3051 | 0.3808 | 0.2937 | 0.3269 |
h7/s | 0.4944 | 0.5098 | 0.3753 | 0.3980 | 0.3611 | 0.2710 | 0.4055 | 0.3192 | 0.2650 | 0.1699 |
h8/s | 0.6682 | 0.5053 | 0.4480 | 0.3968 | 0.3082 | 0.2635 | 0.3280 | 0.3406 | 0.2150 | 0.3597 |
h9/s | 0.6866 | 0.4408 | 0.5232 | 0.3425 | 0.3595 | 0.2364 | 0.3029 | 0.3233 | 0.2625 | 0.1181 |
h10/s | 0.6658 | 0.3565 | 0.3052 | 0.3344 | 0.3911 | 0.2460 | 0.3029 | 0.2986 | 0.2813 | 0.2749 |
h11/s | 0.5310 | 0.5236 | 0.2794 | 0.3448 | 0.3895 | 0.3448 | 0.3308 | 0.3078 | 0.2626 | 0.1813 |
h9/s | 0.8855 | 0.5927 | 0.3653 | 0.3674 | 0.3241 | 0.3714 | 0.3153 | 0.2651 | 0.2694 | 0.2019 |
h10/s | 0.8473 | 0.3004 | 0.4102 | 0.4171 | 0.4553 | 0.3442 | 0.3532 | 0.3571 | 0.2512 | 0.2051 |
∑hi | 8.4343 | 6.3069 | 5.2227 | 5.1368 | 4.5591 | 4.4282 | 4.3687 | 4.2504 | 3.4944 | 2.9885 |
{J_{1\max }} | 7.8279 | 31.4263 | 80.6735 | 69.6688 | 81.161 | 190.0436 | 204.8789 | 253.3385 | 552.7644 | 732.5254 |
{J_{2\max }} | 5.9946 | 27.9385 | 82.6640 | 77.1002 | 84.0519 | 214.9931 | 238.5967 | 301.8268 | 548.4399 | 814.6972 |
{J_{3\max }} | 40.9249 | 82.6025 | 129.6890 | 152.0706 | 138.8546 | 270.9026 | 296.1057 | 340.8264 | 575.4084 | 602.4032 |
∑{J_i} | 54.7474 | 141.9673 | 293.0265 | 298.8396 | 304.0675 | 675.9392 | 739.5813 | 895.9917 | 1676.6127 | 2149.6259 |
Note:{h_i} for the time intervals in seconds, {J_{1\max }}, {J_{2\max }} and {J_{3\max }} for the absolute values of maximum jerk of the joints 1–3, respectively, {J_i} for the total value of jerks (absolute values) of each joint. |
![]() |
Converges to the global optimal solution times | Number of times of falling into the local optimal solution | Converges to the global optimal solution least algebra | Mean convergence generations |
AGA | 30 | 0 | 160 | 190 |
GA | 9 | 18 | 240 | 260 |
No. | Parameter | Value |
1 | {{\rm{L}}_1}/mm | 600 ~ 960 |
2 | {{\rm{L}}_2}/mm | 580 ~ 780 |
3 | {{\rm{L}}_3}/mm | 580 ~ 780 |
4 | {{\rm{ \mathsf{ θ} }}_1}/° | −5 ~ 30 |
5 | {{\rm{ \mathsf{ θ} }}_2}/° | −20 ~ 20 |
6 | {{\rm{ \mathsf{ θ} }}_3}/° | −60 ~ −90 |
7 | {{\rm{B}}_1}/mm | 500 |
8 | {{\rm{B}}_2}/mm | 2093 |
9 | \mathrm{d} /mm | 500 |
Parameter | Value | Parameter | Value |
population size | 50 | Cross probability {u_{c\min }} | 0.8 |
maximum number of generations | 600 | Mutation probability {u_{mmax}} | 0.2 |
Cross probability {u_{c\max }} | 0.99 | Mutation probability {u_{m\min }} | 0.05 |
Constraint | Joint | ||
1 | 2 | 3 | |
Velocity/(deg/s) | 400 | 380 | 380 |
Acceleration/(deg/s2) | 200 | 180 | 180 |
Jerk/(deg/s3) | 100 | 90 | 90 |
Knots /deg | Joint | ||
1 | 2 | 3 | |
g1 | 15.2102 | −16.9058 | −14.758 |
g2 | Virtual point | Virtual point | Virtual point |
g3 | 12.6982 | −13.3764 | −6.8201 |
g4 | 9.307 | −8.8297 | 1.6705 |
g5 | 5.2752 | −3.6047 | 10.0103 |
g6 | 0.8918 | 1.9217 | 17.4333 |
g7 | −3.4917 | 7.25968 | 23.3867 |
g8 | −7.6867 | 11.9948 | 27.4687 |
g9 | −11.4045 | 15.7754 | 29.5034 |
g10 | −14.444 | 18.3502 | 29.4909 |
g11 | −16.5415 | 19.6062 | 27.6194 |
g12 | −17.5212 | 19.5057 | 24.0775 |
g13 | −17.1444 | 18.1618 | 19.1414 |
Parameter | Weight | |||||||||
{W_T} | 0 | 0.9999 | 0.99999 | 0.999993 | 0.999995 | 0.999999 | 0.9999993 | 0.9999995 | 0.9999999 | 1 |
{W_J} | 1 | 0.0001 | 0.00001 | 0.000007 | 0.000005 | 0.000001 | 0.0000097 | 0.0000005 | 0.0000001 | 0 |
h1/s | 0.6895 | 0.5237 | 0.4923 | 0.4077 | 0.3636 | 0.2280 | 0.3071 | 0.3035 | 0.2114 | 0.2418 |
h2/s | 0.6751 | 0.4432 | 0.3989 | 0.4267 | 0.3191 | 0.4687 | 0.3345 | 0.3438 | 0.2524 | 0.2096 |
h3/s | 0.6436 | 0.4758 | 0.3564 | 0.4078 | 0.3177 | 0.5041 | 0.3041 | 0.2955 | 0.3396 | 0.2456 |
h4/s | 0.5616 | 0.5045 | 0.3440 | 0.4342 | 0.3460 | 0.4956 | 0.3985 | 0.3276 | 0.2648 | 0.3534 |
h5/s | 0.5439 | 0.5671 | 0.4442 | 0.4231 | 0.3148 | 0.3607 | 0.3807 | 0.3877 | 0.3253 | 0.1002 |
h6/s | 0.5418 | 0.5636 | 0.4803 | 0.4363 | 0.3091 | 0.2937 | 0.3051 | 0.3808 | 0.2937 | 0.3269 |
h7/s | 0.4944 | 0.5098 | 0.3753 | 0.3980 | 0.3611 | 0.2710 | 0.4055 | 0.3192 | 0.2650 | 0.1699 |
h8/s | 0.6682 | 0.5053 | 0.4480 | 0.3968 | 0.3082 | 0.2635 | 0.3280 | 0.3406 | 0.2150 | 0.3597 |
h9/s | 0.6866 | 0.4408 | 0.5232 | 0.3425 | 0.3595 | 0.2364 | 0.3029 | 0.3233 | 0.2625 | 0.1181 |
h10/s | 0.6658 | 0.3565 | 0.3052 | 0.3344 | 0.3911 | 0.2460 | 0.3029 | 0.2986 | 0.2813 | 0.2749 |
h11/s | 0.5310 | 0.5236 | 0.2794 | 0.3448 | 0.3895 | 0.3448 | 0.3308 | 0.3078 | 0.2626 | 0.1813 |
h9/s | 0.8855 | 0.5927 | 0.3653 | 0.3674 | 0.3241 | 0.3714 | 0.3153 | 0.2651 | 0.2694 | 0.2019 |
h10/s | 0.8473 | 0.3004 | 0.4102 | 0.4171 | 0.4553 | 0.3442 | 0.3532 | 0.3571 | 0.2512 | 0.2051 |
∑hi | 8.4343 | 6.3069 | 5.2227 | 5.1368 | 4.5591 | 4.4282 | 4.3687 | 4.2504 | 3.4944 | 2.9885 |
{J_{1\max }} | 7.8279 | 31.4263 | 80.6735 | 69.6688 | 81.161 | 190.0436 | 204.8789 | 253.3385 | 552.7644 | 732.5254 |
{J_{2\max }} | 5.9946 | 27.9385 | 82.6640 | 77.1002 | 84.0519 | 214.9931 | 238.5967 | 301.8268 | 548.4399 | 814.6972 |
{J_{3\max }} | 40.9249 | 82.6025 | 129.6890 | 152.0706 | 138.8546 | 270.9026 | 296.1057 | 340.8264 | 575.4084 | 602.4032 |
∑{J_i} | 54.7474 | 141.9673 | 293.0265 | 298.8396 | 304.0675 | 675.9392 | 739.5813 | 895.9917 | 1676.6127 | 2149.6259 |
Note:{h_i} for the time intervals in seconds, {J_{1\max }}, {J_{2\max }} and {J_{3\max }} for the absolute values of maximum jerk of the joints 1–3, respectively, {J_i} for the total value of jerks (absolute values) of each joint. |
![]() |
Converges to the global optimal solution times | Number of times of falling into the local optimal solution | Converges to the global optimal solution least algebra | Mean convergence generations |
AGA | 30 | 0 | 160 | 190 |
GA | 9 | 18 | 240 | 260 |