Abstract
This paper investigates the application of particle swarm optimization (PSO) algorithm to plan joint trajectories of the space modular reconfigurable satellite (SMRS). SMRS changes its configuration by joint motions to complete various space missions; its movement stability is affected by joints motions because of the dynamic coupling effect in space. To improve the movement stability in reconfiguration progress, this paper establishes the optimization object equation to characterize the movement stability of SMRS in its reconfiguration process. The velocity-level and position-level kinematic models based on the proposed virtual joint coordinate system of SMRS are derived. The virtual joint coordinate system solves the problem of asymmetric joint coordinate system resulted by the asymmetric joint arrangement of SMRS. The six-order and seven-order polynomial curves are chosen to parameterize the joint trajectories and ensure the continuous position, velocity, and acceleration of joint motions. Finally, PSO algorithm is used to optimize the trajectory parameters in two cases. Consistent optimization results in terms of the six-order and seven-order polynomial in both cases prove the PSO algorithm can be effectively used for joint trajectory planning of SMRS.
1. Introduction
Traditional space systems have been designed to perform a single mission, and the permanently fixed structure cannot be reconfigured for other missions. Furthermore, long development cycle and the launch window limitation lead to the difficulties of current space system to respond quickly to emergencies [1]. To address the limitations of existing space systems, future space systems are expected to have multiple uses and react to unforeseen events [2]. Under this goal, some new spacecraft concepts are proposed, such as cubic cellular satellites [3], satellite formations [4], and reconfigurable satellites [1]. Reconfigurable satellite is a kind of space system with configuration adaptability. It carries multiple types of task subsystem whose space position can be arranged and reorganized by structural reconfiguration to have the ability to perform multiple space missions. For example, one reconfigurable satellite carrying multiple optical cameras could change the space directions of the cameras through the reconfigurable mechanism and splice the fields of view of all cameras to expand the imaging area or, respectively, reconnoiter different targets.
The space modular reconfigurable satellite (SMRS) proposed in this paper is a new type of reconfigurable satellite, which is born with the diversity of space mission but the single mission function of current satellite systems. SMRS is a chain structure satellite composed of different functional modules and joints between the modules (see Figure 1) and could change its configuration adaptively according to the adjustment of space mission. Each module of SMRS is the integration of satellite payloads or subsystems with standard interface and regular shape. The modular design is convenient for the folding and package of satellite in rocket and also for the reconfiguration in space. Different from the reconfigurable satellites that used own manipulators [5], external service robots or autonomous flight [6] to change their configuration, SMRS change its configuration by joint motions. Each module of SMRS is connected by three rotation joints that are mutually orthogonal and provide the freedom degrees of pitch, roll, and yaw between modules. Different configurations are realized by relative rotation between modules. Thus, SMRS can adjust its configuration adaptively according to the requirements of space mission and the mission capability of SMRS is improved accordingly. The structure of 5-module SMRS is shown in Figure 1. What should be noted is that the type and number of satellite modules and payloads carried can be configured according to the requirements of space missions.
SMRS requires multiple reconfigurations in space to adapt to the various space missions. Unlike the reconfigurable system with fixed base on the ground, SMRS is with such a characteristic that any joint motion will affect the pose of other modules because of the floating rootless state of the space system, which is also known as the dynamic coupling effect between joint motion and pose of modules [7, 8]. The dynamic coupling effect can be described by the position-level and velocity-level kinematic model of SMRS.
The dynamic coupling effect makes the changes in pose of space reconfigurable system more complicated. In order to reduce the impact of the dynamic coupling effect or use it, the joint trajectory of space reconfigurable system such as space robots is planned by many researchers. Under different space mission requirements, the forms of optimization objective for joint trajectory planning are not uniform. In space missions, common optimization objective includes the following: (1) the minimum disturbance of the base [9–11]. When a space system carries numerous precision instruments and payloads with high requirements for orientation in the base, the base disturbance is required to be small in the reconfiguration process; (2) minimum pose error of end effector. For the space reconfigurable missions, such as space capture, which requires high precision of the final pose of the end effector, the error between the end effector and its desired pose should be reduced as much as possible; (3) minimum energy consumption [12]; (4) optimal reconfigurable time [13, 14], for temporary or more urgent space missions; (5) obstacle avoidance [12]; (6) the lowest jerk [15]; and (7) minimum joint rotation angle [14].
However, a special characteristic for SMRS is that it may carry payloads in every module. To maintain their continuous working state, severe pose changes are not allowed in the reconfiguration process. For example, severe pose disturbance may cause communication interruption between satellite and ground control center [10]. At the same time, as a multijoint chain system, severe pose change will lead to system vibration and other dynamic problems. Hence, this paper explores the feasibility of using trajectory planning method to improve the stability of SMRS and puts forward the procedures and methods in detail.
The logic of joint trajectory planning of SMRS is to set the optimization objective equation and define the control parameters of the joint trajectory which are the typical parameters that can define the joint trajectory. According to the optimization objective equation, the relationship between the control parameters and the optimization objective equation is derived. Under a series of equality or inequality constraints, the optimization algorithm is used to iteratively optimize the control parameters, and then optimized control parameters are used to obtain a specific joint trajectory. Therefore, the complete joint trajectory planning process mainly includes the following steps: (1) establish an optimization objective equation, (2) parameterize joint trajectory and define control parameters, (3) select an optimization algorithm to optimize the control parameters, and (4) solve the optimized joint trajectory.
The first problem encountered is not only the characterization of reconfiguration stability of SMRS but also the form of optimization objective equation. Because of the equal importance of each module of SMRS, feasible optimization objective equation can be weighted sum of each module pose velocity. However, this form of the optimization objective equation will be too complicated to impose high requirements on space computing resources. Therefore, this paper derives the relationship between the module pose and the joint trajectory to propose a more simplified and practicable optimization objective equation and clarifies the application of the PSO algorithm for joint trajectory planning under multiple joint constraints.
Based on this, the paper is arranged as follows: in Section 2, we establish the velocity-level and position-level kinematic equations of the SMRS to describe the dynamic coupling effect between pose velocity and joint trajectories; in Section 3, the optimization objective equation and constraints of joint trajectory planning are determined, and the joint trajectory is parameterized to determine the optimal parameters of the joint trajectory; in Section 4, we analyze the principle and steps of the PSO algorithm used in joint trajectory planning of SMRS; In Section 5, the PSO algorithm is used to plan the trajectories of SMRS from folding configuration to deployment configuration and from deployment configuration to mission configuration; in Section 6, we discuss and summarize the work.
2. Kinematic Model of SMRS
Due to the dynamic coupling effect between the pose of each module and the joint trajectories, the trajectory planning in space is more complex than that of reconfigurable mechanism on fixed base [16]. When planning the trajectory of each joint to improve the stability of the SMRS, the description of the stability is related to the changes of the pose of each module. Therefore, the coupling effect between the trajectory of each joint and the pose of each module should be clarified by the velocity-level kinematic model of SMRS. At the same time, the real-time pose of each joint in the velocity-level kinematic model needs to be calculated using the position-level kinematic model. In this section, the kinematic model of velocity-level and position-level of SMRS is established, respectively.
2.1. Velocity-Level Kinematic Model
Firstly, the meaning of the symbols in the kinematic modeling process of SMRS is defined and summarized in Table 1. The two joints of SMRS are connected by a connecting rod. At this time, the module can also be regarded as a connecting rod with a special shape. Usually, the attitude control module is selected to establish the base coordinate system of SMRS, and the base coordinate system is used to divide the satellite structure of SMRS into and sides. The structure diagram of SMRS is established as shown in Figure 2.
In Figure 2, represents the selected base; , represents the connecting rods located in the side of , , represents the connecting rods located in the side of ; and and represent the th joint on both and sides, respectively. and are the numbers of joints on the and side, respectively. Each connecting rod has one center of mass coordinate system whose origin is on the connecting rod’s center of mass and axes are parallel to .
According to reference [17], the position of in SMRS can be expressed by
Deriving the time of Equation (1), the velocity of each connecting rod is obtained in the following equation:
In addition, the relationship between the angular velocity of each connecting rod and the rotational angular velocity of each joint is shown in the following equation:
Equations (2) and (3) are arranged into a matrix form, and the velocity vector of the th connecting rod on both the and sides is obtained: where are pose vectors of the th connecting rod on the and side.
is the Jacobian matrix related to the motion of ; is the Jacobian matrix related to the motion of the connecting rod. When , then
In the free-floating state of SMRS, the pose of the space system is not controlled during the reconfiguration which can minimize the energy consumption. Simultaneously, assuming no other external forces and torques act on SMRS, in this state, the position of the CM will remain unchanged in inertia space. Therefore, we choose the CM as origin of to make to simplify calculation. In addition, the whole SMRS satisfies the condition of conservation of momentum; that is, both the linear momentum and the angular momentum are conserved. Assuming initial momentum of SMRS is 0, its conservation equations of linear momentum and angular momentum are, respectively, shown in Equations (9) and (10).
Defining the angular momentum relative to center of mass as , the angular momentum of SMRS is . According to the law of conservation of momentum, . Therefore , the momentum conservation equation of SMRS is transformed into
In Equation (11),
For rotating joint,
, is the vector from the origin of to the CM; then, the momentum conservation equation can be further simplified to obtain the relationship between the linear velocity, angular velocity, and joint rotation angle of the base as shown in the following equation:
Arranging Equation (14), we obtain
is the Jacobian matrix of the base and joint trajectories. Equation (15) shows the coupling effect between the pose of the base and the joint motion.
Take Equation (15) into Equation (4), we can obtain
is a generalized Jacobian matrix (GJM) about the pose of each connecting rod, joint trajectories, and mass characteristics of SMRS. It represents the dynamic coupling effect between the motion of each joint and the pose of each connecting rod and proves that the motion of any joint will affect the pose of every connecting rod.
2.2. Position-Level Kinematic Model
The velocity-level kinematic model of SMRS is derived above, and the Jacobian matrix related to the connecting rod’s velocity and joint trajectories is obtained. The calculation of the Jacobian matrix needs the real-time pose of each connecting rod which is described by the position-level kinematic model. Therefore, it is necessary to deduce the position-level kinematic model of SMRS.
Among the various kinematic modeling methods of multiconnecting rod systems, the Denavit–Hartenberg method (D-H) [18] is not only suitable to establish the coordinates of the multiconnecting rod system but also simple and fast to iterative calculate the connecting rod poses using multiconnecting rod homogeneous transformation. Moreover, the D-H method can be used for Jacobian matrix analysis and dynamic calculations. Therefore, this paper adopts the D-H method to establish the coordinate system of SMRS and calculate the pose of each connecting rod. According to the principles of establishing the coordinate system in the D-H method, each joint is fixed with a joint coordinate system; then, the coordinate calculation can be performed between the coordinate systems through the homogeneous matrix transformation. Through successive transformations of each joint’s coordinate system, the pose of joints and connecting rods can also be derived.
The D-H method selects four parameters between adjacent coordinate systems to describe the relationship of the coordinate system; they are link length ; link twist , link offset , and joint angle . The four parameters of D-H are referenced to the current coordinate system to perform a determined four-step transformation to obtain a transformation matrix from the ()th coordinate system to the th coordinate system:
If there is a point in space whose coordinate in the th coordinate system is and its coordinate in the ()th coordinate system is , then the relationship between and can be expressed as
After times of transformations, the pose of the th connecting rod can be reached, as shown in Equation (19), and the total transformation matrix between the base and th connecting rod is obtained by multiplying the transformation matrices between adjacent coordinate systems.
The first step of establishing the SMRS’s kinematic model is to define the coordinate system. The of SMRS is established in the center of mass of attitude control module, and the connecting rod coordinate systems in two sides ( side, side) are established, respectively, on either side of . In some space systems such as space dual-arm robots, the joint axis orientations on both sides of are always consistent during design, so the D-H parameters on both sides are equal. However, the three joints between the modules of the SMRS are series designed, and they are orthogonal to each other. Meanwhile, it is not possible to make special designs for the joints on both sides of the base coordinate system to keep their direction consistent because the position of is not fixed. As shown in Figure 3, when the first joint coordinate system on the side is completely coincident with the base coordinate system, its -axis is perpendicular to the -axis of the second joint on the side; however, the first joint axis on the side is orthogonal to the joint axes of 1 and 2 on the side, so that the -axis of is parallel to the first joint axis on the side which violates the principle of establishing the coordinate system in the D-H method.
To solve the problem, a virtual joint coordinate system is proposed. Virtual joint coordinate system Jv is a coordinate system established between the base coordinate system and the first joint coordinate system on the side to solve the problem that the -axis of is parallel to the -axis of the first joint on the side. The D-H coordinate systems of SMRS and virtual joint coordinate system are shown in Figure 3.
The standard for establishing the virtual joint coordinate system is as follows: the -axis of the virtual joint coordinate system is perpendicular to the -axis of and the -axis of the first joint coordinate system on the side, and the -axis is perpendicular to the -axis of the first joint coordinate system on the side. At the same time, the origin of the virtual joint coordinate system coincides with the origin of . Because of the introduction of the virtual joint coordinate system, the degree of freedom of SMRS is increased by 1. When mass and structural size are set to 0 and remain always static, the virtual joint does not affect the quality parameters and dimensions of the system. Then, the calculation of the pose matrix of the connecting rod on the b side only needs to multiply the transformation matrix from the virtual joint coordinate system to the base coordinate system between the first joint coordinate system and .
3. Trajectory Optimization of SMRS
3.1. Cost Function and Constraints
According to the derivation in Section 2, it can be known that the pose of base is affected by the trajectories of joints. Because of the functional characteristics, SMRS has the specific configuration in a specific space missions, which requires every joint to move to a certain angle within a certain mission time. Due to the conservation of momentum in space, the total pose changes of connecting rods relative to are constant values from the current configuration to the target configuration. It means the joint trajectories would not affect the mean values of the connecting rod’s pose velocity curves. What would be affected by joint trajectories are the shapes of pose velocity curves, which are closely related to the movement stability of SMRS. The improvement of movement stability of SMRS is supposed to provide a more stable state for important instruments carried in satellite modules and avoid sudden torque changes between joints.
Therefore, improving the movement stability of SMRS in the reconfiguration process is taken as the optimization objective of joint trajectory optimization. When the pose velocity curves of connecting rods are continuous and smooth, their movement stability can be characterized by the pose velocity extremums. The movement stability of SMRS depends on pose velocities of all connecting rods. Nevertheless, to reduce the complexity of the cost function, we choose the sum of the absolute extremums of all linear and angular velocities of one or several selected modules to characterize the movement stability of SMRS. The selected module can be different by different evaluation standards. At this time, the cost function of this optimization problem can be defined in the following equation: where is the number of selected modules and, are velocity vectors of them.
The joint trajectories directly affect the stability of the actuator output torques [19]. In order to ensure the smoothness of the joint trajectories in SMRS, the initial value, end value, velocity, and acceleration of each joint trajectory need to be constrained to satisfy Equations (21)–(32). where and are the initial time and end time of the mission; and are the joint angle vectors of both sides of and , respectively; and are the joint angle vector of the side at initial and end time, respectively. and are the joint angle vector of b side at initial and end time, respectively. , are the vector of maximum joint angle allowed, maximum joint angular velocity, and maximum joint angular acceleration., , are the vector of minimum joint angle, minimum joint angular velocity, and minimum joint angular acceleration allowed.
3.2. Parameterization of Joint Trajectory
In order to ensure the above constraints in Equations (21)–(32) and define the control parameters, the joint trajectory is usually parameterized by some curves which include polynomials [20–22], trigonometric functions, Bezier curves [23], and spline difference curves [24, 25]. Among them, the polynomial is an ideal parameterized curve because of its simple form. At the same time, its order can be changed according to the joint differential constraints of different orders, and the number of control parameters can be arbitrarily selected. In this paper, a polynomial whose general form is expressed by Equation (33) is used to parameterize the joint trajectories.
While the constraints for continuity and smoothness of velocity, acceleration, and smoothness are satisfied in Equations (21)–(28), the minimum order of the polynomial is 5. Considering fewer control parameters can accelerate the convergence of the optimization process, 6-order and 7-order polynomials which have only one and two control parameters, respectively, are chosen to parameterize the joint trajectories. (1)Use Equation (33) to parameterize the 6-order polynomial for each joint trajectory on both sides of and . At this time, , set as the initial time of joint motion, and bring the constraints in Equations (21)–(28) into Equation (33) to obtain
From Equations (34)–(37), we know that the parameterized th joint trajectory can be written as an equation with polynomial coefficients , as parameters, and its specific form is shown in the following equation:
According to Equation (38), when the constraints in Equations (21)–(32) remain unchanged, the trajectory curve can be adjusted by changing the polynomial coefficient , of the th joint trajectory. It means that , can be seen as the trajectory control parameter to optimize cost function. Since each joint trajectory has one control parameter after parameterization, the optimization vector on the or side of the system is determined as . (2)Use Equation (33) to parameterize the 7-order polynomial for each joint trajectory on both sides of and . At this time, , set as the initial time of joint motion, and bring the constraints in Equations (21)–(28) into Equation (33) to obtain
From Equations (39)–(42), we know that the parameterized th joint trajectory can be written as an equation with polynomial coefficients , as parameters, and its specific form is shown in the following equation (43):
According to Equation (43), when the constraints in Equations (21)–(32) remain unchanged, the trajectory curve can be adjusted by changing the polynomial coefficient , of the th joint trajectory. It means that , can be seen as the trajectory control parameters to optimize the cost function. Since each joint trajectory of SMRS has two control parameters after parameterization, the optimization vector on the or side of SMRS is determined as .
Introducing the parameterized joint trajectory into Equation (15), the relationship between control parameters and optimization objectives can be obtained based on the form of cost function in Equation (20). At this time, the optimization problem of the cost function is transformed into the optimization of control parameters.
4. PSO Algorithm
When the cost function and the optimization vector composed of the control parameters are determined, certain methods are needed to optimize the joint trajectory to achieve the optimization objective. Among all kinds of optimization methods, heuristic algorithm is widely used in joint trajectory planning, including simulated annealing (SA), genetic algorithm (GA), particle swarm optimization (PSO) [24], and ant colony optimization (ACO) [14] algorithm.
In this paper, the PSO algorithm is used to plan the joint trajectories of SMRS. The PSO algorithm is an intelligent optimization algorithm based on swarm intelligence [24], which is widely used to solve all kinds of engineering problems. Many researchers improve it or combine it with other algorithms to achieve better optimization results for different problems [26, 27]. Compared with other optimization algorithms, the PSO algorithm has the following superiorities: (1) few built-in parameters need to be adjusted; (2) it can find the optimal or approximate optimal solution of nonlinear and discontinuous problems in a higher dimension; (3) it is easy to realize by computer; (4) the unidirectional information flow makes the whole search and update process follow the current optimal solution, which makes the convergence speed faster [28].
The PSO algorithm first initializes a group of random particles of each optimization parameter and updates the fitness to find the optimal solution of the optimization parameter through each iteration. For the trajectory planning problem of SMRS, the fitness is the value of the cost function. Initially, the position of the th particle in each group of particles is set as , and its initial velocity is [29]. The velocities and positions of all particles are updated iteratively according to Equation (44) and (45) to seek better fitness:
In Equation (44), is inertia weight which controls the search field. is the local optimal position of the th particle. is the global optimal position. and are learning factors usually in [0.5, 2]; and are random numbers. In the process of optimization, the particle position is evaluated by fitness, and the local optimal position of every particle so far and the global optimal position of particle swarm so far are searched in search space. The motion of each particle is guided by and which are updated in every generation. When we get the best fitness so far, that is to say, the particle position at this time is the better position found so far. This process is repeated generation by generation until the termination conditions are met. In this process, the and the of all particles are two important values.
An important step in the PSO algorithm is to impose constraints on the optimization parameters. In this paper, the specific strategies to impose constraints on in the process of repairing infeasible solutions are as follows:
At the same time, the particle’s velocity also needs to be constrained. If is too large, it is easy to cross the optimal solution. If the is too small, the convergence speed of the fitness is slow. The constraining strategy of is the same as that of , as shown in the following equation:
In Equations (46) and (47), , and are the upper and lower limits set for and . In the iteration of the PSO algorithm, the iteration termination condition of particles is often set as the maximum number of iterations or the optimal position so far has met the predetermined minimum fitness threshold. This article chooses maximum number of iterations as the termination condition.
The constraints of joint angle, velocity, and acceleration in Equation (29) is realized by penalty function in Equations (48)–(50) in the PSO algorithm.
In Equations (48)–(50), can be any value far beyond the possible fitness. The current global optimal optimization parameters are brought into the trajectory curve to calculate the maximum value of joint angle, velocity, and acceleration. If they exceed the set intervals, the fitness will return to and restart calculation. The flow of using the PSO algorithm to plan joint trajectories is shown in Figure 4.
5. Trajectory Planning Simulation
In this paper, SMRS composed of 9 connecting rods and 24 joints is selected as the research object. And the middle module is selected as the base module, and is fixed to it. Considering the base module usual carries the important subsystems such as a housekeeping computer, the cost function in Equation (20) is defined as the sum of absolute extremums of all linear and angular velocities of the base module. The parameters of the D-H coordinate system established by the initial state of linear SMRS are shown in Table 2. The connecting rod parameters of each joint of SMRS are shown in Table 3. The inertia weight , learning factors and , , , , , , , and , are set in the PSO algorithm. The iteration termination condition is chosen as the maximum number of iterations and is set to 100.
5.1. Case 1
In order to reduce the occupied fairing space and facilitate the multistar package and launch, SMRS is usually the folded state shown in Figure 5(a) at launch and then unfold after getting into orbit. The unfolding process is shown in Figure 5(b), and the unfolded state is shown in Figure 5(c). In case 1, the trajectory planning of SMRS unfolding process is simulated while the initial time is set as 0 and the mission time as 60 s.
(a)
(b)
(c)
The unfolded state of SMRS is a linear state which is also the state in which the coordinate system is established by the D-H method. The joint angle vectors relative to the linear state are of the side and of the side. When SMRS is in the folded state, the unfolded state is the linear state, at this time, . In order to ensure the stability of joint motion, the angular velocity and acceleration at the initial and end time of each joint angle are set to 0. The range of control parameters is set as to ensure the monotonicity of trajectory curves.
While planning joint trajectories in the form of 6-order polynomials, the optimization parameter vector composed of 8 optimization parameters is . While planning joint trajectories in the form of 7-order polynomial, the optimization parameter vector composed of 8 optimization parameters is .
The PSO algorithm is used to optimize the trajectory parameters in the form of 6-order polynomial and 7-order polynomial, respectively, and their convergence process of fitness is shown in Figures 6(a) and 6(b).
(a)
(b)
The optimization results in Figure 6(a) show that the fitness value converges to 0.0484 based on the optimization vector which converges to [0, 0, 0, 0], and at this time, the highest order coefficient of the 6-order polynomial is 0; then, the polynomial is converted to the 5-order polynomial.
The optimization results in Figure 6(b) show that the optimal fitness value converges to 0.0484 based on the optimization vector which converges to [0, 0, 0, 0, 0, 0, 0, 0], and at this time, the highest and second highest order coefficient of the 7-order polynomial are 0; then, the polynomial is converted to the 5-order polynomial, too.
The trajectory, velocity, and acceleration curves of joint trajectory parameterized by the 5-order polynomial are shown in Figure 7, from which we can see that the trajectory of each joint is smooth and meets the requirements for the joint velocities and accelerations. The joint trajectory optimization results in the form of 6-order and 7-order polynomials prove that 5-order polynomials are ideal trajectory parameterization curves under the conditions of satisfying the velocities and accelerations of joint motions.
(a)
(b)
(c)
By introducing the joint trajectory in the form of 5-order polynomial into Equation (14), the pose velocity curves of from the folded state to unfolded state are obtained and shown in Figure 8. We can see that the pose velocities of are small, and the reconfigurable process is stable because they are within the limited interval and have not changed drastically.
(a)
(b)
When the trajectory is parameterized by the 5-order polynomial, the curves related to pose velocities of and mission time are drawn in Figure 9. It indicates that with the prolongation of the mission time, the linear velocities and angular velocities of SMRS of slow down. When the mission time is fully prolonged, the satellite will reconfigure at very low velocities. When the maximum allowable angular velocity of is set to 0.005, as shown in Figure 9, each velocity curve will have one intersection with the angular velocity threshold line; then, maximum abscissa of these intersections’ read out is 400 s, which means the minimum feasible mission time in case 1 is 400 s.
5.2. Case 2
Case 2 conducts the trajectory planning simulation of SMRS from the unfolded state to a certain mission configuration, and their configurations are shown in Figures 10(a) and 10(b). The joint angle vector of SMRS in the unfolded state is . At the end of the mission, the state changes to a certain mission configuration whose joint angle vector is , and the nine modules of SMRS are divided into three groups; each group has three modules and has different directions relative to other groups. SMRS in this configuration can carry out reconnaissance missions in three directions simultaneously. The initial time is set to 0 and mission time to 60 s. In order to ensure the smoothness of joint trajectories, the joint angular velocities and accelerations at initial time are set to 0.
(a)
(b)
The parameter setting of the particle swarm algorithm in case 2 is consistent with that in case 1. While planning joint trajectories in the form of 6-order polynomials in case 2, the optimization parameter vector composed of 2 optimization parameters is ; while planning joint trajectories in the form of 7-order polynomials, the optimization parameter vector composed of 4 optimization parameters is .
The PSO algorithm is used to optimize the trajectory parameters in the form of 6-order polynomial and 7-order polynomial, respectively, and their convergence process of fitness is shown in Figures 11(a) and 11(b).
(a)
(b)
In Figure 11(a), the fitness value converges to 0.02 while the optimization vector converges to [0, 0], and at this time, the highest order coefficient of the 6-order polynomial is 0; then, the polynomial is converted to the 5-order polynomial.
In Figure 11(b), the fitness value converges to 0.02 based while the optimization vector converges to [0, 0, 0, 0], and at this time, the highest and second highest order coefficient of the 7-order polynomial are 0; then, the polynomial is converted to the 5-order polynomial, too.
In Figure 11, the optimization results of the trajectory in case 2 in the form of 6-order and 7-order polynomials prove that the 5-order polynomials are ideal trajectory parameterized curves under the conditions of satisfying the velocity and acceleration of joint motions. The trajectory, velocity, and acceleration curves of joint trajectories parameterized by 5-order polynomial are shown in Figure 12; we can see that the joint trajectory is smooth and meets the requirements of joint trajectory velocity and acceleration.
(a)
(b)
(c)
The joint trajectory in the form of 5-order polynomial is introduced into Equation (14), and the velocity curves of three position directions and three joint axis angle changes of in the process of reconfiguration from the unfolded state to mission state are obtained. What we can see from Figure 13 is that the pose velocities of the base coordinate system are within the limited interval and have not changed drastically, and the reconfigurable process is relatively stable.
(a)
(b)
When the trajectory is parameterized by the 5-order polynomial, the curves related to pose velocities of and mission time are drawn in Figure 14. It indicates that with the prolongation of mission time, the linear velocities and angular velocities of SMRS of slow down. When the mission time is fully prolonged, the satellite will change its pose at small velocities. According to Figure 14, the minimum mission time with threshold of pose velocity can be read. When the maximum allowable linear velocity of is set to 0.005, as shown in Figure 14, each velocity curve will have one intersection with the linear velocity threshold line; then, the maximum abscissa of these intersections’ read out is 20 s, which means the minimum feasible mission time in case 2 is 20 s.
6. Conclusion
Based on the reality that the traditional space system can only perform a single mission and is difficult to respond quickly to emergencies, this paper proposes a new concept spacecraft named space modular reconfigurable satellites which is expected to perform multiple space missions and respond to unforeseen events by carrying multiple mission subsystems and structural reconfiguration. In the process of adaptive reconfiguration of SMRS, there is a coupling effect between the motion of each joint and the pose of each modules. Aiming at the stability of the reconfiguration process, the paper established the kinematic equations of SMRS, and the joint trajectories of SMRS are parameterized by the 6-order and 7-order polynomials, respectively. The trajectories of SMRS from folded configuration to unfolded configuration and from unfolded configuration to a mission configuration are planned by the PSO algorithm. The main conclusions are as follows: (1)In the process of adaptive reconfiguration of SMRS, there is a coupling effect between the joints motion and the pose of each module which provides theoretical support for improving the reconfiguration stability of SMRS by joint trajectory plan(2)The D-H method based on the virtual joint coordinate system can effectively solve the problem of space orientation asymmetry of reconfigurable joints axis on both sides of base coordinate system of SMRS(3)The PSO algorithm for trajectory planning can quickly converge, and the optimized trajectories meet the set constraints. The consistent results of different parameterized curves in one case prove the PSO algorithm is an ideal intelligent algorithm for trajectory planning of SMRS
This paper completed research on the kinematic modeling and trajectory planning of SMRS. The research results provide a reference for the kinematics and dynamics modeling, control, and joint trajectory selection of SMRS and other reconfigurable space systems.
Data Availability
The data used to support the findings of this study are included within the article.
Conflicts of Interest
The authors declare no conflict of interest.
Acknowledgments
This research was funded by National Defense Science and Technology Innovation Zone of China, grant number 00205501.