International Journal of Astronautics and Aeronautical Engineering
(ISSN: 2631-5009)
Volume 8, Issue 1
Research Article
DOI: 10.35840/2631-5009/7565
Non-Holonomic Path Planning for Space Robots Based on Jerk Constraints
Pengfei Xiao1, Jinhua Zhou2*, Chunping Zhou1, Yuan Si1 and Dong Zhou3
Table of Content
Figures
Figure 5: Curves of angular velocity....
Curves of angular velocity, acceleration and secondary acceleration of each joint of space robot.
Tables
Table 1: The DH parameters of the space robot.
Table 2: The dynamic parameters of the space robot.
References
- Tafazoli MA (2009) A study of on-orbit spacecraft failures. Acta Astronautica 64: 195-205.
- Li W-J, Cheng D-Y, Liu X-G, Wang Y-B, Shi W-H, et al. (2019) On-orbit service (OOS) of spacecraft: A review of engineering developments. Progress in Aerospace Sciences 108: 32-120.
- Stoll E, Letschnik J, Walter U, Artigas J, Kremer P, et al. (2009) On-orbit servicing. IEEE Robotics & Automation Magazine 16: 29-33.
- Xu W, Liu Y, Liang B, Xu Y, Li C, et al. (2008) Non-holonomic path planning of a free-floating space robotic system using genetic algorithms. Advanced Robotics 22: 451-476.
- Zappa BF, Legnani G, Adamini R (2005) Path planning of free-flying space manipulators: An exact solution for polar robots. Mechanism and Machine Theory 40: 806-820.
- Yoshida K (2009) Achievements in space robotics. IEEE Robotics & Automation Magazine 16: 20-28.
- Wu Y-H, Yu Z-C, Li C-Y, He M-J, Hua B, et al. (2020) Reinforcement learning in dual-arm trajectory planning for a free-floating space robot. Aerospace Science and Technology 98: 105657.
- Zhang FH, Fu YL, Wang SG (2009) A path planning method for free-floating space robot in Cartesian space. Robot.
- Ratajczak J, Tchon K (2020) Normal forms and singularities of non-holonomic robotic systems: A study of free-floating space robots. Systems & Control Letters 138: 104661.
- Chen G, Zhang L, Jia Q, Chu M, Sun H (2013) Repetitive motion planning of free-floating space manipulators. International Journal of Advanced Robotic Systems 10: 253.
- Zhang H, Zhu Z (2020) Sampling-based motion planning for free-floating space robot without inverse kinematics. Applied Sciences 10: 9137.
- Dubowsky S, Torres MA (1991) Path planning for space manipulators to minimize spacecraft attitude disturbances. In: Proceedings of IEEE International Conference on Robotics and Automation, IEEE, Sacramento, CA, USA, 2522-2528.
- Yoshida K (2003) Engineering test satellite VII flight experiments for space robot dynamics and control: Theories on laboratory test beds ten years ago, now in orbit. The International Journal of Robotics Research 22: 321-335.
- Huang P, Chen K, Xu Y (2006) Optimal path planning for minimizing disturbance of space robot. International Conference on Control, Automation, Robotics and Vision, IEEE, Singapore, 1-6.
- Cocuzza S, Pretto I, Debei S (2012) Least-squares-based reaction control of space manipulators. Journal of Guidance, Control, and Dynamics 35: 976-986.
- Park K-j, Park Y-S (1993) Fourier-based optimal design of a flexible manipulator path to reduce residual vibration of the endpoint. Robotica 11: 263-272.
- Nakamura Y, Mukherjee R (1990) Nonholonomic path planning of space robots via a bidirectional approach. IEEE Transactions on Robotics and Automation 7: 500-514.
- Xu W, Li C, Liang B, Xu Y, Liu Y, et al. (2009) Target berthing and base reorientation of free-floating space robotic system after capturing. Acta Astronautica 64: 109-126.
- Papadopoulos E, Tortopidis I, Nanos K (2005) Smooth planning for free-floating space robots using polynomials. International Conference on Robotics and Automation, IEEE, Barcelona, Spain, 4272-4277.
- Yoshida K, Kurazume R, Umetani Y (1991) Dual arm coordination in space free-flying robot. In: International Conference on Robotics and Automation, IEEE, Sacramento, CA, USA, 2516-2521.
- Wang M, Luo J, Fang J, Yuan J (2018) Optimal trajectory planning of free-floating space manipulator using differential evolution algorithm. Advances in Space Research 61: 1525-1536.
- Liu Y, Jia Q, Chen G, Sun H, Peng J (2015) Multi-objective trajectory planning of FFSM carrying a heavy payload. International Journal of Advanced Robotic Systems 12: 118.
- Mitsushige O (1997) Motion control of the satellite mounted robot arm which assures satellite attitude stability. Acta Astronautica 41: 739-750.
- Huang P, Xu Y, Liang B (2005) Dynamic balance control of multi-arm free-floating space robots. International Journal of Advanced Robotic Systems 2: 13.
- Gang C, Jia Q, Sun H, Zhang X (2010) Non-holonomic path planning of space robot based on Newton iteration. 8th World Congress on Intelligent Control and Automation, IEEE, Jinan.
- Jin R, Rocco P, Geng Y (2021) Cartesian trajectory planning of space robots using a multi-objective optimization. Aerospace Science and Technology 108: 106360.
- Misra G, Bai X (2017) Task-constrained trajectory planning of free-floating space-robotic systems using convex optimization. Journal of Guidance, Control, and Dynamics 40: 2857-2870.
- Kennedy J, Eberhart R (1995) Particle swarm optimization. In: Proceedings of ICNN'95 - International Conference on Neural Networks.
- Parsopoulos KE, Vrahatis MN (2002) Recent approaches to global optimization problems through Particle Swarm Optimization. Natural Computing 1: 235-306.
- Wei B, Xia X, Yu F, Zhang Y, Xu X, et al. (2020) Multiple adaptive strategies based particle swarm optimization algorithm. Swarm and Evolutionary Computation 57: 100731.
Author Details
Pengfei Xiao1, Jinhua Zhou2*, Chunping Zhou1, Yuan Si1 and Dong Zhou3
1AVIC Research Institute for Special Structures of Aeronautical Composite, Jinan, China
2School of Mechanical Engineering, Shandong University, Jinan, China
3Army Engineering University of PLA, Nanjing, China
Corresponding author
Jinhua Zhou, School of Mechanical Engineering, Shandong University, Jinan 250061, China.
Accepted: May 17, 2023 | Published Online: May 19, 2023
Citation: Xiao P, Zhou J, Zhou C, Si Y, Zhou D (2023) Non-Holonomic Path Planning for Space Robots Based on Jerk Constraints. Int J Astronaut Aeronautical Eng 8:065
Copyright: © 2023 Xiao P, et al. This is an open-access article distributed under the terms of the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original author and source are credited.
Summary
In order to solve the problems of poor stability and low joint life of space robots, this paper proposes a non-holonomic path planning model for free-flying space robots considering jerk constraints. Firstly, the attitude of the space robot is described by the unit quaternion, through the analysis of the differential motion equation of the space robot, the velocity relations among the base, joint angle, and the end-effector are established. Secondly, the joint trajectories were parameterized by the seventh-order sinusoidal function. Then, according to the jerk constraint, the precision of the pedestal disturbance, and the task completion time, the optimal path planning model of the pedestal disturbance and time synthesis is proposed. Finally, the particle swarm optimization algorithm is used to solve the optimal path optimization problem of the space robot. The simulation results show that the proposed trajectory planning method effectively solves the problems of low maintenance efficiency and large base disturbance of the space robot under jerk constraints.
Keywords
Space robot, Jerk, Trajectory optimization, Base disturbance, Non-holonomic path planning
Introduction
With more and more types of space equipment, damage to spacecraft equipment occurs every year due to component failures. After some spacecraft are launched into orbit, problems such as component failure and orbit deviation may occur [1-3]. While some spacecraft complete their scheduled missions and run out of fuel, their main structures and components can still function normally, at this time, through the space robot for in-orbit maintenance, the fuel supply and component replacement can make the failure of the spacecraft to return to normal operation, prolong the service life of the spacecraft, increase economic benefits. In addition, some large-scale complex structured space equipment has appeared one after another. In the future, space robots can be used to repair large-scale equipment in orbit to provide guarantee for the normal operation of space missions.
Space robot is one of the main ways to achieve on-orbit maintenance. Space operating devices cannot operate normally due to faults, aging and other reasons. In order to enhance the service life of space equipment, the space robot is used to complete the maintenance tasks of all kinds of space equipment through on-orbit operation. Because of the particularity of space robot, it has been studied and concerned by many scholars [4-9]. The motion of the space manipulator will affect the position and attitude of the base, and the change of the base pose of the space robot will in turn affect the accuracy of the end-effector of the space robot, leading to the failure of the maintenance task. After the space robot completes the capture task, the base attitude of the space robot changes due to the dynamic coupling effect. Based on the non-holonomic characteristics of the space robot, the path planning is carried out. By controlling the motion of the joint of the manipulator, the joint angle and the base attitude angle of the manipulator converge to the desired state simultaneously [10,11].
Dubowsky and Torres [12] proposed an enhanced perturbation mapping technique to plan the motion of the space manipulator, so that the perturbation of the base attitude was relatively small. Yoshida [13] focused on the planning and control of the manipulator using the generalized Jacobian matrix and the concept of reaction null space. Huang [14] proposed an optimal path planning method based on genetic algorithm (GA) with minimum base reaction interference, but the implementation of the genetic algorithm is relatively complex. Xu [15] adjusted the attitude of the base by adjusting the joint angle on the basis of estimating the reaction force of the joint motion of the manipulator on the base. Papadopoulos [16] used polynomial functions to carry out path planning for the manipulator, and by controlling the movement of the manipulator, the end pose of the manipulator and the attitude of the base can reach the desired goal at the same time. Yoshida, et al. [17] studied the free motion law of both arms and proposed the concept of two-arm coordination. The motion of one manipulator arm was used to compensate the influence of the motion of another manipulator arm on the attitude of the base. Wang [18] used the concept of reaction null space to describe the motion law of robot in free-floating space, and adopted Bezier curve to describe the joint trajectory. Cocuzza and Pretto [19] proposed a redundancy decomposition method based on constrained least squares to ensure that the disturbance of the space manipulator base is minimized. Liu and Jia [20] proposed a maximum load trajectory planning method based on multi-objective optimization for a space robot carrying heavy loads to move to the desired pose. Oda [21] proposed the coordinated control between the satellite attitude control system and the manipulator control system, which required the simultaneous control of the satellite attitude and the joint of the manipulator, but this would consume more control fuel. Huang and Xu [22] developed a space robot system that consists of two arms, one of which is used to complete the capture task and the other is used to compensate the interference of the base, but this method increases the complexity of the system. Park [23] used a mixed function of Fourier and polynomials to describe the trajectory, and used motion planning to optimize the residual vibration of the robot.
Non-holonomic path planning is to adjust the attitude of the base by controlling the movement of the manipulator without consuming fuel. At present, researches on non-holonomic path planning of space robots are extensive [24-27], but the situation of space jerk is not considered. Space robots have high requirements for flexibility, stability and efficiency, and the conservation of linear momentum and angular momentum should be considered. In this paper, a jerk-based space robot trajectory planning model is established based on the existing research methods, which can ensure that the space manipulator meets the high efficiency and base stability.
The rest of this article is arranged as follows: In Section 2, the symbolic representation and theoretical basis of space robots are introduced. In Section 3, the Cartesian space trajectory planning problem is analyzed, and the joint trajectory is parameterized by sinusoidal function curve, and the objective function and constraint conditions of the planning are analyzed in detail. In Section 4, the particle swarm optimization algorithm is proposed to solve the non-holonomic path planning of space robot based on jerk constraints. In section 5, the feasibility of the plan is verified by experimental simulation and the results are discussed. Section 6 provides the conclusion.
Theoretical Foundation of Space Robot System Modeling
Space robot model and symbolic representation
The model of the space robot is shown in Figure 1, which is composed of a space manipulator and a spacecraft base platform. Define the base of the spacecraft as rigid body B0, the ith link of the manipulator is rigid body Bi, the joint connecting rigid body Bi-1 and rigid body Bi is Ji, the center of mass of rigid body i is mi, the mass of rigid body i is mi, the total mass of the system is M, and the moment of inertia of the rigid body i to its center of mass is Ii.
If there is no special indication in this article, they are all indicated under the inertial system.
The position vector of the end of the manipulator is denoted as pe, the position vector of the center of mass of the rigid body Bi is denoted as ri, the unit vector of the rotation axis of joint Ji is denoted as ni, the position vector from Ji to Ci is denoted as ai, and the position vector from Ci to Ji+1 is denoted as bi.
Kinematics equation of space robot
The position vector of the end of space robot can be expressed as:
The linear velocity at the end is expressed as
The angular velocity at the end is expressed as
The linear velocity and angular velocity of the end effector of the space robot can be uniformly expressed in the form of a matrix as:
Where Jb is the Jacobian matrix related to the movement of the base, Jm is the Jacobian matrix related to the motion of the manipulator, θ is the joint angle vector.
The position and attitude of the base of the space robot are not controlled. When it is not affected by external forces and moments, the linear momentum and angular momentum of the system are conserved. Assuming that their initial values are zero, the momentum conservation equation of the center of mass of the base satisfies the following constraints:
According to the equation (5),
then
The matrix Jbm is the base-manipulator Jacobian matrix.
Quaternion representation of rigid body attitude
There are Euler angle, axis-angle, rotation transformation matrix and unit quaternion methods to describe the attitude of rigid body. Among them, when using Euler angles and axis-angle methods to describe the attitude, it is easy to produce singular phenomena. The rotation matrix must satisfy the constraint of orthogonal normalization. When this constraint cannot be satisfied, the rotation matrix will be ill-conditioned and the calculation error will be relatively large. However, the use of unit quaternion can avoid these problems. The module of unit quaternion is 1, which has stronger robustness relative to the ill-conditioned rotation transformation matrix. There is a one-to-one mapping relationship between unit quaternion and attitude, so the singularity can be avoided.
The representation of the unit quaternion is shown below
Among them, q is the rotation axis, which is the unit vector, and is the angle of rotation around the rotation axis.
The relationship between the time derivative of the unit quaternion and the angular velocity is as follows
Among them, is the antisymmetric matrix of q, and 1 is the identity matrix.
Consider two coordinate systems, the attitude quaternions are Q1 and Q1 respectively, and the relative attitude δQ is
When the two coordinate systems point to the same point, then , .
Cartesian Path Planning Problem
Problem description
In this paper, the non-holonomic path planning problem of space robot under jerk constraints is studied. The influence of manipulator motion on the attitude of the base should be considered, and the disturbance of the base should be as small as possible. The operating environment of space robot is different from that of ordinary industrial robot, and its service life is an important consideration. An important factor affecting the service life of space robot is the jerk of joints, which will not only affect its service life, but also affect its accuracy. To solve the above problems, a path planning model of space robot considering jerk constraints is proposed in this paper. By controlling the motion of the manipulator joints, the joint angle and the base attitude angle of the manipulator are converging to the desired state at the same time, so as to ensure the relocation of the base attitude of the space robot during the motion process.
For the convenience of discussion and research, the hypothetical conditions for the study of space robot in this paper are as follows:
1) All components of the space robot system are rigid bodies, and each connecting rod joint has a rotational degree of freedom;
2) The movement of space robot solar panels and the shaking of fuel are not taken into account;
3) Ignoring the influence of microgravity, various friction and resistance, the space robot system is not affected by any external force and torque, and linear momentum and angular momentum are conserved.
4) The effect of orbital mechanics on the trajectory of space robot is ignored.
Parameterization of the trajectory
Because the sine function has the property of boundary, this paper uses the seventh order polynomial sine function to describe the joint trajectory motion of the space robot. At this time, the displacement, velocity, acceleration and jerk of each joint are continuous, and the motion mutation is avoided.
Where
The joint velocity is
The joint acceleration function is
The secondary acceleration function of the joint is
Constraint conditions
During the motion of the space robot, the angle, velocity and acceleration of each joint are all subject to certain physical limitations. At the initial and final moments, the velocity and acceleration of each joint are all zero. This paper considers the addition of secondary acceleration constraints to ensure that the jerk is within a safe range, which is beneficial to improve the service life of the joints. The space robot satisfies the following equality constraints and inequality constraints during the planning process.
Equality constraints:
Inequality constraints:
In order to ensure that the space robot can work smoothly and the jerk is within a safe range, the constraint on joint jerk is added in this paper, namely
Among them, is the upper limit of the jerk of the joint i respectively.
Objective function
The goal of space robot trajectory planning is to generate the applicable joint motion law without violating the constraint conditions, so that the joint angle and the attitude of the base of space robot can reach the desired state at the same time, so as to complete the desired space task. In this paper, the cost function of the base disturbance is defined as
Since the total external force and the total external moment of the space robot system are 0, the position and attitude of the base at the final moment is shown in equation (19)
The error between the final attitude and the desired attitude of the space robot base is
In order to ensure the working efficiency of space robot, the cost function of time is defined as
In order to make the space robot meet the requirements of work efficiency and base stability, the total operating time and base disturbance are used as components to establish a comprehensive and optimal objective function of time and base disturbance.
Where Kb is the weight of the base disturbance, and Kt is the weight of time, KT + Kb = 1.
Solution of the Path Planning Problem based on PSO
Particle Swarm Optimization Algorithm
Particle Swarm Optimization (PSO) [28-30] is an intelligent optimization algorithm based on random search, which has high efficiency and effectiveness. The key to particle swarm optimization is to determine the local and global optimal values of particles, and make use of information sharing by individuals in the group to make the whole group movement in problem solving space from disorder to order evolution process. The particle uses its own experience and the best experience in the group to update the next movement, so as to obtain the optimal solution to the problem.
The particle updates its velocity and position according to the following formula:
Among them, is the optimal solution known to the individual, is the optimal solution known to the population, is the inertia weight, c1, c2 are the learning factor, r1, r2 are the random number within [0,1], and is the velocity adjustment factor.
Non-holonomic path planning based on PSO
The advantage of particle swarm optimization lies in its method based on swarm intelligence and its fast convergence velocity. By using the 7th-order polynomial sine function to parameterize the joint angle, and substituting the equation constraint condition (15) into the formulas (11)-(13), we can get
Therefore, each joint of the space robot contains two parameters αi6 and αi7.
The fitness function is the optimization index of the algorithm. Different optimization goals have different evaluation indexes. In the process of trajectory planning of space robot, it is necessary to ensure that the velocity, acceleration and secondary acceleration of the joint are within the specified range, so the penalty function mechanism is introduced to ensure that.
Among them, Kb is the weight of the base disturbance, Kt is the weight of time, , and are determined according to the joint angular velocity, angular acceleration and angular secondary acceleration, As formulas (26)-(28), , , are the corresponding penalty factors respectively.
The calculation flow chart of fitness function is shown in Figure 2.
In this paper, particle swarm optimization algorithm is used to solve the path planning model based on the jerk constraints to find the best parameter the particle swarm optimization algorithm is used to solve the non-holonomic path planning based on jerk constraint.
Simulation Research
In order to solve the problem of minimum perturbation of the base and optimal time of the space robot, this paper uses the 7th-order sinusoidal polynomial function to parameterize the joint angle. According to the objective function and constraint conditions, the fitness function of the algorithm was defined, the practical problem was transformed into an optimization problem, and the optimal path of the space robot was determined by finding the minimum value of the fitness function.
Basic parameters of space robot
The space robot system studied in this paper is composed of a base and a 6-DOF manipulator. The DH system of the space robot is shown in Figure 3, the DH parameters are shown in Table 1, and the dynamic parameters are shown in Table 2.
According to the task requirements of the space robot, the non-holonomic path trajectory is planned in the given initial state and target state, and the planned trajectory function is required to be continuous and smooth to make the space robot manipulator move smoothly.
Experimental results
The joint angle at the initial moment of the space robot is set as and the desired joint angle at the final moment is set as the Euler angle of the base at the initial moment is expressed as , and the expected Euler angle of the base at the final moment is set as . The range of joint angle of space robot is shown as follows:
The range of joint angular velocity is shown in the following formula:
The range of joint angular acceleration is shown in the following formula:
The range of joint angle secondary acceleration is shown in the following formula:
The coefficient of the fitness function is determined by the accuracy requirement. In this article, we assume that the rotation angle of the base attitude does not exceed 1deg. Therefore, the coefficients of fitness function should be defined separately, as shown in the following formula:
The particle swarm optimization algorithm is very sensitive to parameters, and the corresponding parameters in this experiment are set as: The number of iterations is Nmax = 1000, the population size is NP = 150, the maximum inertia weight is wmax = 0.9, the minimum inertia weight is wmin = 0.1, the accelerated constant is c1 = c2 = 2.
Through simulation calculation, the optimal parameters searched by the particle swarm optimization algorithm is
The minimum value of fitness function is J* = 3.223.
It can be seen from Figure 4 that during the entire movement, the joint angles are within the range of the manipulator joint angle. From Figure 5, it can be seen that the joint angular velocity, joint angular acceleration, and joint angular secondary acceleration also meet the corresponding constraints. In order to display the change of the base attitude intuitively, ZYX Euler angle is adopted in this paper to represent the base attitude. As can be seen from Figure 6, the base attitude is adjusted to the desired attitude. The simulation results show that the problem of low maintenance efficiency and high base disturbance of space robot can be effectively solved by using particle swarm optimization algorithm to solve the problem of base disturbance based on jerk constraint and time comprehensive optimal path planning.
Conclusion
According to the operation requirements of on-orbit maintenance tasks, space robot needs to adjust its attitude when completing some on-orbit operation tasks. There is a dynamic coupling relationship between the base of space robot system and the manipulator, and the attitude of the base can be adjusted by the motion of the joints. This paper uses the non-holonomic characteristics of the space robot to achieve the desired value of the joint angle and the attitude of the base at the same time, and a comprehensive model of optimal path planning is established for base disturbance and time based on the jerk constraint by using the 7th-order polynomial sine function to parameterize the joint angle, and the path planning model is used to plan the path of the space robot, so that the velocity, acceleration, and secondary acceleration of each joint of the space robot meet the kinematic constraints. The simulation results show that the non-holonomic path planning based on jerk constraints can solve the problems of low efficiency and large base disturbance of 15 space robot in orbit maintenance more effectively.
Acknowledgments
This study is supported by the Natural Science Foundation of Shandong Province (No. ZR2022QE199) and the Open Project Program of Shandong Marine Aerospace Equipment Technological Innovation Center, Ludong University (No. MAETIC202207).
Declaration of Competing Interest
The authors declare that they have no known competing financial interests or personal relationships that could have appeared to influence the work reported in this paper.