Static control method of continuum robot
Through the new static model and posture expression method, combined with motion static modeling and inverse static control, the control problem caused by the complexity of static factors of continuum robots is solved, and efficient and precise static control is achieved, improving the The ability of robots to apply in complex environments.
Patent Information
- Application Number
- CN202411048279.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-01
- Publication Date
- 2024-12-06
AI Technical Summary
Continuous robots have a model mismatch problem in morphological estimation and reverse modeling control, especially the complexity of static factors makes it difficult to solve inverse static control, affecting control accuracy and efficiency.
A new static model and pose expression method is proposed. Through kinematic static modeling and inverse static control method, the driving rope tension, friction and external load are considered, and the target pose is approached by search mode, simplifying the calculation and improving efficiency.
The accuracy of the model and the efficiency of the calculation are realized, the inverse static control is simplified, the time cost is reduced, and the accuracy and flexibility of the continuous robot control are improved.
Smart Images

Figure CN119077724A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of continuum robot control, and in particular to a statics control method of a continuum robot. Background Art
[0002] Continuum robots, also known as snake-like robots, are inspired by creatures in nature such as elephant trunks and octopus tentacles. They have high degrees of freedom and a large aspect ratio. These advantages enable continuum robots to flexibly enter narrow and complex environments to perform tasks, such as aircraft engine blade grinding, combustion chamber maintenance, nuclear power pipeline inspection, human cavity inspection, minimally invasive surgery, etc., and have excellent application value.
[0003] One of the challenges facing continuum robots is morphological estimation and inverse modeling control. Whether the modeling of the robot arm is accurate will directly affect its actual shape and terminal posture, and directly determine its control accuracy. The modeling methods for continuum robot morphology estimation usually include kinematic models and mechanical models (statics and dynamics). Kinematic modeling is favored by many researchers due to its simplicity, but it ignores mechanical factors such as gravity, friction, external loads, etc. In practice, each part of the robot arm is not a constant arc, which will cause model mismatch problems. Statics and dynamics modeling add considerations to mechanics and can estimate the actual posture of the robot arm more accurately, but the calculation of the current mechanical model is relatively complex and requires a high time cost, especially for inverse statics control. The addition of mechanical factors makes it difficult to confirm the shape of the robot arm, and the configuration space is even more difficult to solve.
[0004] Therefore, it is urgent to develop a statics modeling method for a rope-driven continuum robot, fully considering mechanical factors, including driving rope tension, friction, and external loads, in order to establish an accurate statics model of the continuum robot, and on this basis develop an efficient inverse statics control method to solve the problem of solving inverse modeling control.
[0005] The above information disclosed in this Background section is only for enhancement of understanding of the background of the invention and therefore it may contain information that does not form the prior art that is already known to a person of ordinary skill in the art. Summary of the invention
[0006] The present invention provides a statics control method for a continuum robot. For a line-driven continuum robot, a new statics model and a simpler way of describing the continuum robot's posture are innovatively optimized. Based on this, a statics control method for a search mode is proposed, which has the advantages of accurate model, simple operation, and efficient calculation.
[0007] A statics control method for a continuum robot includes:
[0008] Step 1: Set the target node of the continuum robot, and set the node position coordinates of each segment of the continuum robot's robotic arm according to the posture of the environment or work requirements;
[0009] Step 2: Kinematic statics modeling: construct the static equilibrium equation of the manipulator arm of the continuum robot torque and the bending angle of the elastic rod with each joint as the unit, and solve the rotation angle of each joint according to the input driving rope tension to obtain the posture of the entire manipulator arm;
[0010] Step 3: Inverse statics control, adjust the driving rope tension according to the stiffness to approach the target posture in a search manner.
[0011] In the static control method of a continuum robot, in step 1, the direction of the node of each driving segment of the continuum robot and the initial point of the robot arm is used to represent the position and posture of the entire continuum robot arm.
[0012] In the statics control method of a continuum robot, step 2 comprises:
[0013] Step 21: Construct the relationship between the drive rope length and the joint angle according to the geometric relationship of the robot arm joint structure, establish the forward kinematics model from the drive space to the configuration space and then to the workspace, and the reverse inverse kinematics model, that is, the spatial transformation of the position coordinates;
[0014] Step 22: Calculate the tension of the drive rope, and solve the tension of each drive rope at each disk of the robot arm according to the joint angle;
[0015] Step 23: Establish the torque equation and calculate the torque of various forces and loads acting on each joint separately;
[0016] Step 24: Establish a balance equation to solve the joint angle. Construct a balance equation based on the relationship between the bending angle of the flexible rod and the torque. Calculate and solve the rotation angle of each joint to obtain the posture of the entire continuum robotic arm.
[0017] In the statics control method of a continuum robot, in step 22, the forces include driving rope tension, friction, gravity and external load, the friction force is divided into friction between the driving rope and the rope hole and friction at the joint; gravity includes the gravity of the disc, flexible rod, driving rope and wire lock; the external load includes external torsional load and force load.
[0018] In the static control method of a continuum robot, in step 22, the point of application of the force is set to the center of the surface of a disk in front of each joint, the bending angle of the flexible rod is equal to the joint angle, and its relationship with the torque is expressed based on Kirchhoff's elastic rod theory, wherein the bending angle of the flexible rod is equal to the ratio of the product of the torque and the rod length to the product of Young's modulus and the moment of inertia.
[0019] In the static control method of a continuum robot, the initial tension of all driving ropes is set to zero, and each time the driving force is updated, the nodes of each driving segment are recalculated based on the proposed motion statics model, and gradually iterated to the target node.
[0020] In the statics control method for a continuum robot, the stiffness is the ratio of a small change in the driving force at the current position to a small displacement of the node in the direction of the driving rope.
[0021] In the static control method of a continuum robot, the base coordinate system is set at the zeroth joint one joint distance forward from the first joint, the Z axis is along the axial direction of the robot arm, the Y axis is vertically upward, and the set target node includes X and Y coordinates.
[0022] In the static control method of a continuum robot, the stiffness is solved to update the driving rope tension, the solved nodes of each driving segment are compared with the target node, and the change in the driving rope tension is solved according to the stiffness at the current position, thereby updating the driving force.
[0023] In the static control method of a continuum robot, the iteration ends when the error between the solved node position and the target node position is less than a set value, and the tension magnitude and change length of each drive rope and the position and posture of the robot arm are output.
[0024] Compared with the prior art, the present invention has the following advantages: The statics model of the present invention solves the equilibrium equation for each unit separately to offset the influence of the subsequent rope tension, and the calculation is relatively simple, which is conducive to improving the efficiency of statics calculation. The posture representation method of the continuum robot can make the analysis form skip the configuration space, and only the node position of each driving segment and the direction of the initial point are needed to represent the posture of the continuum robot, avoiding the complex calculation of the configuration space. The inverse statics control method uses the forward statics iteration method to approximate the target position, avoiding the complexity of direct reverse calculation, and has the advantages of simplicity and efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] By reading the detailed description of the preferred specific embodiments below, various other advantages and benefits of the present invention will become clear to those of ordinary skill in the art. The drawings in the specification are only for the purpose of illustrating the preferred embodiments and are not considered to be limitations of the present invention. Obviously, the drawings described below are only some embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained based on these drawings without creative work. Moreover, the same reference numerals are used to represent the same components throughout the drawings.
[0026] In the attached picture:
[0027] Figure 1 It is a flow chart of a statics control method of a continuum robot disclosed in the present invention;
[0028] Figure 2 It is a schematic diagram of kinematic modeling disclosed in the present invention;
[0029] Figure 3 It is a schematic diagram of the driving force and friction force modeling disclosed in the present invention;
[0030] Figure 4 It is a schematic diagram of the statics principle disclosed in the present invention taking the driving force as an example;
[0031] Figure 5 It is a complete algorithm flow chart of the statics control method disclosed in the present invention;
[0032] Figure 6 It is a new method for describing the posture of a continuum robot disclosed in the present invention;
[0033] Figure 7 It is a diagram of the experimental results of the statics model disclosed in the present invention;
[0034] Figure 8 It is a diagram of experimental results of the inverse statics control method disclosed in the present invention.
[0035] The present invention is further explained below in conjunction with the accompanying drawings and embodiments. DETAILED DESCRIPTION
[0036] The specific embodiments of the present invention will be described in more detail below with reference to the accompanying drawings. Although the specific embodiments of the present invention are shown in the accompanying drawings, it should be understood that the present invention can be implemented in various forms and should not be limited by the embodiments set forth herein. On the contrary, these embodiments are provided in order to enable a more thorough understanding of the present invention and to fully convey the scope of the present invention to those skilled in the art.
[0037] It should be noted that certain words are used in the specification and claims to refer to specific components. Those skilled in the art should understand that technicians may use different nouns to refer to the same component. This specification and claims do not use the difference in nouns as a way to distinguish components, but use the difference in the functions of the components as the criterion for distinction. As mentioned throughout the specification and claims, "including" or "comprising" is an open term, so it should be interpreted as "including but not limited to". The subsequent description of the specification is a preferred embodiment of the present invention, but the description is based on the general principles of the specification and is not intended to limit the scope of the present invention. The scope of protection of the present invention shall be determined by the attached claims.
[0038] To facilitate understanding of the embodiments of the present invention, further explanation will be given below by taking specific embodiments as examples in conjunction with the accompanying drawings, and each of the accompanying drawings does not constitute a limitation on the embodiments of the present invention.
[0039] like Figures 1 to 8 As shown, the static control method of the continuum robot includes the following steps:
[0040] Step 1: Set the target node of the continuum robot, and set the node position coordinates of each segment of the continuum robot's robotic arm according to the posture of the environment or work requirements;
[0041] Step 2: Kinematic statics modeling, construct the static equilibrium equation of the manipulator arm of the continuum robot, solve the rotation angle of each joint according to the tension of the driving rope, and thus obtain the position and posture of the entire manipulator arm;
[0042] Step 3: Inverse statics control, adjust the driving rope tension according to the stiffness to approach the target posture in a search manner.
[0043] In a preferred implementation of the static control method of a continuum robot, in step 1, the direction of the node of each driving segment of the continuum robot and the initial point of the robot arm is used to represent the posture of the entire continuum robot arm.
[0044] In a preferred embodiment of the static control method of a continuum robot, step 2 comprises:
[0045] Step 21: Construct the relationship between the driving rope length and the joint angle according to the geometric relationship of the robot arm joint structure, and establish the forward and inverse kinematics model;
[0046] Step 22: Calculate the tension of the drive rope, and solve the tension of each drive rope at each disk of the robot arm according to the joint angle;
[0047] Step 23: Establish the torque equation and calculate the torque of various forces and loads acting on each joint separately;
[0048] Step 24: Establish a balance equation to solve the joint angle. Construct a balance equation based on the relationship between the bending angle of the flexible rod and the torque. Calculate and solve the rotation angle of each joint to obtain the posture of the entire continuum robotic arm.
[0049] In a preferred implementation of the static control method for a continuum robot, in step 22, the forces include drive rope tension, friction, gravity and external load, and the friction force is divided into friction between the drive rope and the rope hole and friction at the joint; gravity includes the gravity of the disc, flexible rod, drive rope and wire lock; and the external load includes external torsional load and force load.
[0050] In a preferred embodiment of the static control method of a continuum robot, in step 22, the point of application of the force is set to the center of the surface of a disk in front of each joint, the bending angle of the flexible rod is equal to the joint angle, and its relationship with the torque is expressed based on Kirchhoff's elastic rod theory.
[0051] In a preferred implementation of the statics control method for a continuum robot, the initial tension of all drive ropes is set to zero, and each time the drive force is updated, the nodes of each drive segment are recalculated based on the proposed motion statics model, and gradually iterated to the target node.
[0052] In a preferred implementation of the statics control method for a continuum robot, the stiffness is the ratio of a small change in the driving force at the current position to a small displacement of the node in the direction of the driving rope.
[0053] In a preferred embodiment of the static control method of a continuum robot, the base coordinate system is set at the zeroth joint one joint distance forward from the first joint, the Z axis is along the axial direction of the robot arm, the Y axis is vertically upward, and the set target node includes X and Y coordinates.
[0054] In a preferred implementation of the static control method for a continuum robot, the stiffness is solved to update the driving rope tension, the solved nodes of each driving segment are compared with the target node, and the change in the driving rope tension is solved according to the stiffness at the current position, thereby updating the driving force.
[0055] In a preferred implementation of the static control method for a continuum robot, the iteration ends when the error between the solved node position and the target node position is less than a set value, and the tension magnitude and change length of each drive rope, as well as the robot arm posture are output.
[0056] In one embodiment, a static control method for a continuum robot includes:
[0057] In this embodiment, the structural unit of the continuum robot is a double-core column structure, each joint has only one rotational degree of freedom, and the rotation directions of the joints are arranged vertically and staggered along the main axis direction, and every two joints form a unit.
[0058] In this embodiment, the following are defined: 1) coordinate system {O i ,X i ,Y i ,Z i} is located at the center of the i-th joint. When the robot arm is straight (the joint bending angle is 0), Y i The axis is vertically upward relative to the ground, Z i The axis is along the main axis of the robot arm; Definition 2) The number of drive segments is s, the number of joints m is an even number, and the first joint revolves around Xi Definition 3) Each driving segment is driven by four driving ropes, and according to Y i The axes are symmetrically distributed.
[0059] In this embodiment, it is assumed that: 1) the processing and assembly errors of the various parts of the continuum robot are very small and can be ignored; and 2) the driving rope will not be stretched and deformed due to the application of tension.
[0060] Step 1: Set the target node. Based on the proposed continuum robot posture description method, set the coordinates of the end point of each driving segment according to the posture of the environment or work requirements.
[0061] Step 1 also includes the following steps: Step 11: A new method for describing the posture of a continuum robot, using the direction of the node of each driving segment and the initial point of the robot arm to represent the posture of the entire continuum robot arm, such as Figure 6 As shown in the figure, due to the continuity and flexibility of the continuum robot, each section of the robot arm can be regarded as a flexible curve. This curve has unique bending characteristics under the influence of the structure itself. When the first vertebral disc is fixed (the initial point and initial direction are fixed), the process from straight bending to the maximum bending angle has posture uniqueness, that is, any point on the terminal trajectory corresponds to a unique posture. Since the first section of the robot arm is fixed at the driving end, its initial point and initial direction are fixed, so its posture can be determined only by the position coordinates of a point in its bending trajectory. After the posture of the first section is determined, its end point is also the initial point of the second section. The position and direction of the point have been determined, so the posture of the second section of the robot can be expressed by the end point of the second section. Similarly, the posture of the entire robot is also determined. The setting of the target node only includes the X and Y coordinates, and the Z coordinate is determined due to the mechanical properties. The traditional posture expression method is based on the piecewise constant curvature theory (PCC), which ignores the mechanical factors and only calculates the configuration space through geometric relationships, which will cause the actual and model to be incompatible. When considering the mechanical factors, the angles of each joint are different. When the drive space is unknown, the configuration space is obviously difficult to calculate. This method allows the analysis form to skip the configuration space and avoid this problem.
[0062] Step 2: Kinematic statics modeling, construct the static equilibrium equation of the entire continuum robot arm, solve the rotation angle of each joint according to the tension of the driving rope, and thus obtain the position and posture of the entire continuum robot arm.
[0063] Step 2 also includes the following steps: Step 21: Kinematic modeling, according to the geometric relationship of the joint structure of the robot arm, construct the relationship between the drive rope length and the joint angle, and establish the forward and inverse kinematics model, as follows: Figure 2 As shown, the joint angle of the i-th joint is defined as θ i, respectively construct the homogeneous transformation matrix T of odd-numbered joints and even-numbered joints, that is:
[0064]
[0065] Among them, k is the unit number, R is the rotation matrix, p is the translation vector, and h represents the distance between two adjacent joint centers;
[0066] Furthermore, the homogeneous transformation matrix T of the kth unit and the sth segment is constructed k and T s ,Right now:
[0067]
[0068] Among them, skmax and skmin represent the maximum and minimum unit numbers in the sth segment respectively;
[0069] Furthermore, an inverse kinematics model is constructed to derive the relationship between the joint angle and the rope length change Δl based on the geometric relationship of the continuum robot structural unit, that is:
[0070]
[0071] Where j is the number of the drive rope, l represents the length of the nickel-titanium rod, represents the angle of the rope hole relative to the X-axis, and r represents the radius of the rope hole from the center.
[0072] Step 22: Calculate the tension of the drive rope. Considering the friction at the rope hole, solve the tension of each drive rope at each disk according to the joint angle, such as Figure 3 As shown, there are two rope holes on the upper and lower surfaces of the i-th disk, and the friction coefficient will change with the joint angle, that is:
[0073]
[0074] in, and are the friction coefficients at the upper surface of the i-1th disk and the lower surface of the i-th disk respectively;
[0075] Furthermore, the friction force f at the i-th disk is calculated, that is:
[0076]
[0077] Among them, f - and f + Represent the friction forces at the lower and upper surfaces of the disk respectively, and F represents the tension of the drive rope.
[0078] Furthermore, the direction of friction force can be determined according to the change of rope length, that is,
[0079]
[0080]
[0081] Where, ΔL i,j represents the sum of the length changes of cable j at all joints after joint i;
[0082] Furthermore, the driving rope tension at the i-th joint is calculated, namely:
[0083] F i,j =F i-1,j +sgn(ΔL i,j )·f i-1,j
[0084] Where F represents the driving rope tension.
[0085] Step 23: Establish the torque equation and calculate the torque of various forces and loads acting on each joint separately, such as Figure 4 As shown in the figure, first construct the torque of the driving rope pulling force acting on the i-th joint. Although the two forces at any joint act on different vertebral disc positions, they are equal in magnitude and opposite in direction, and their force arms to the i-th joint are the same, so the two forces can cancel each other out. Therefore, only the action of the force closest to the i-th joint is retained, that is:
[0086]
[0087] Where F represents the driving rope tension vector, M F Represents the torque vector generated by the driving rope tension, O i-1 Represents relative to the coordinate system {O i-1},O HD and O HU Respectively represent the coordinates of the rope holes on the lower and upper surfaces of the disk, O VU Represents the position coordinates of the center of the disk's upper surface.
[0088] Furthermore, to construct the moment of gravity acting on the i-th joint, first list the gravity matrix G i ,Right now:
[0089]
[0090] Among them, m i g represents the weight of the disk (including tightening screws), flexible rod, drive rope or locking wire in the ith joint, O G Represents relative to the coordinate system {O G};
[0091] Further, solve the gravity vector to coordinate system {Oi-1}, that is:
[0092]
[0093] in is the inverse of the homogeneous transformation matrix from the zero joint to the i-1th joint.
[0094] Further, solve the moment M of gravity acting on the i-th joint G ,Right now:
[0095]
[0096] Among them, O t Represents the position of the center of mass of each part. It should be noted that all the above calculation formulas for gravity torque are general formulas, and the weight of each part needs to be considered separately.
[0097] Furthermore, the torque of the external load acting on the i-th joint is constructed. The external load is divided into two forms: external force and external torque. First, the torque M of the external force is calculated. FEX ,Right now:
[0098]
[0099] Among them, F EX represents the external force vector, O EX Indicates the position where the external force acts;
[0100] Further, calculate the external torque M MEX And the total external load acting on the moment M of the i-th joint EX ,Right now:
[0101]
[0102] Furthermore, the torque of the joint friction acting on the i-th joint is constructed as Figure 3 As shown, joint friction can be divided into two parts. First, the moment M of friction on the side plane is calculated. T ,Right now:
[0103]
[0104] in, represents the components of each part of the torque acting on the ith joint in the X, Y, and Z directions respectively;
[0105] Furthermore, the friction moment M on the arc surface is calculated. R ,Right now:
[0106]
[0107] Among them, f R represents the friction force vector at the arc surface, which is obtained by averaging multiple experiments, and r represents the arc surface radius vector;
[0108] Further, calculate the total moment M of joint friction at the i-th joint f ,Right now:
[0109]
[0110] Step 24: Establish the torque equation and the balance equation to solve the joint angle. According to the relationship between the bending angle of the flexible rod and the torque, the balance equation is constructed to calculate and solve the rotation angle of each joint, so as to obtain the posture of the entire continuum robot arm. The bending angle of the flexible rod is equal to the joint rotation angle, and its relationship with the torque is expressed based on Kirchhoff's elastic rod theory, that is:
[0111]
[0112] Among them, M NiTi represents the torque on the nickel-titanium rod, E is Young's modulus, and I is the moment of inertia of the flexible rod.
[0113] Step 3: The inverse statics control method is used to obtain the robot arm posture based on the proposed kinematic statics modeling method, and the driving rope tension is adjusted according to the stiffness to approach the target posture in a search manner.
[0114] Step 3 also includes the following steps: Step 31: Solve the stiffness to update the driving rope tension. Based on the proposed motion statics model, compare the solved nodes of each driving segment with the target node, solve the change of the driving rope tension according to the stiffness of the current position, and then update the driving force. First, calculate the stiffness K of the manipulator s (Slight change in driving force at current position The small displacement of the node in the direction of the driving rope The ratio of) is:
[0115]
[0116] in, and Represents the component of the node on the coordinate axis;
[0117] Furthermore, the driving rope tension is updated according to the distance difference and stiffness between the current node and the target node, that is:
[0118]
[0119] F j ′=F j +ΔF j
[0120] Where ΔF represents the change in the tension of the driving rope, and F′ represents the changed tension of the driving rope.
[0121] according to Figure 5 As shown, the complete algorithm flow of the static control method is as follows:
[0122] First, the target node is set. Based on the proposed method for describing the posture of the continuum robot, the node position coordinates of each segment of the robot arm are set according to the posture of the environment or work requirements. At the same time, the parameters are initialized, and the driving rope tension and each joint angle are set to 0.
[0123] Furthermore, the kinematic statics calculation of the robot arm is performed to solve the posture. Through iterative updating, the driving rope tension in the driving space is used as a known input to calculate the new joint angle θ′. If the variance of the joint angle is less than ε 1 , then the solution of kinematic statics is completed, otherwise θ is updated according to certain rules and then recalculated;
[0124] Furthermore, the distance between the current node and the target node of the first segment of the robot arm is calculated based on the position output by kinematic statics. If the distance is less than ε 2 , the next segment is calculated until all segment nodes meet the requirements and the calculation is completed and the change in the length of the driving rope, the tension of the driving rope, and the position and posture of the robot arm are output; if the distance is not less than ε 2 , the stiffness of the robot arm is calculated and the driving rope tension is updated. At this time, the driving rope tension is used as a known input and the kinematic statics calculation is performed again to solve the posture.
[0125] Next, the present disclosure describes the technical effects of the above method.
[0126] In the static model calculation and solution of posture, multiple groups of simulation calculations are performed. For a single-segment (10 joints) continuum robotic arm, the average calculation time is only 0.06s; for a two-segment (10 joints per segment, totaling 20 joints) continuum robotic arm, the average time is only 0.13s; for a three-segment (10 joints per segment, totaling 30 joints) continuum robotic arm, the average time is only 0.36s.
[0127] In the inverse statics control method, multiple groups of simulation calculations were performed. For a single-segment (10 joints) continuum robotic arm, the average calculation time was only 0.43s; for a two-segment (10 joints per segment, totaling 20 joints) continuum robotic arm, the average time was only 2.54s; for a three-segment (10 joints per segment, totaling 30 joints) continuum robotic arm, the average time was only 55.58s.
[0128] like Figure 7As shown, under the 14 designed working conditions, the static model of a three-section (10 sections in each section, 30 joints in total, with a total length of 240 mm) continuum robotic arm was experimentally verified. The first 8 working conditions were in a two-dimensional plane, and the last 6 working conditions were in three-dimensional space. The maximum error at the end of the robotic arm was 6.99 mm, which only accounted for 2.91% of the entire robotic arm length.
[0129] Furthermore, under the two designed trajectories, the inverse statics control of the continuum robotic arm at both ends (10 joints in each section, totaling 20 joints, with a total length of 160 mm) was experimentally verified. The two trajectories were a circle with a radius of 50 mm and the letter combination "XJTU". The maximum error at the end of the robotic arm was 5.92 mm, which was only 3.70% of the entire length of the robotic arm.
[0130] The correctness and feasibility of the method described in the present invention are verified by comparing the above embodiments.
[0131] Although the embodiments of the present invention are described above in conjunction with the accompanying drawings, the present invention is not limited to the above specific embodiments and application fields, and the above specific embodiments are only illustrative and instructive, rather than restrictive. A person of ordinary skill in the art can also make many forms under the guidance of this specification and without departing from the scope of protection of the claims of the present invention, all of which belong to the protection of the present invention.
Claims
1. A static control method for a continuum robot, characterized in that: The steps include: Step 1: Set the target node of the continuum robot, and set the node position coordinates of each segment of the continuum robot's robotic arm according to the posture of the environment or work requirements; Step 2: Kinematic statics modeling: construct the static equilibrium equation of the continuum robot torque and the bending angle of the elastic rod with each joint as the unit, and solve the rotation angle of each joint according to the input driving rope tension to obtain the posture of the entire robot arm; Step 3: Inverse statics control, adjust the driving rope tension according to the stiffness to approach the target posture in a search manner.
2. The static control method of a continuum robot according to claim 1, characterized in that: Preferably, in step 1, the direction of the node of each driving segment of the continuum robot and the initial point of the robotic arm is used to represent the posture of the entire continuum robotic arm.
3. The static control method of a continuum robot according to claim 1, characterized in that: Step 2 includes, Step 21: Construct the relationship between the drive rope length and the joint angle according to the geometric relationship of the robot arm joint structure, establish the forward kinematics model from the drive space to the configuration space and then to the workspace, and the reverse inverse kinematics model, that is, the spatial transformation of the position coordinates; Step 22: Calculate the tension of the drive rope, and solve the tension of each drive rope at each disk of the robot arm according to the joint angle; Step 23: Establishing the torque equation, wherein the torque of various forces and loads acting on the joint is calculated for each joint individually; Step 24: Establish a balance equation to solve the joint angle. Construct a balance equation based on the relationship between the bending angle of the flexible rod and the torque. Calculate and solve the rotation angle of each joint to obtain the posture of the entire continuum robotic arm.
4. The statics control method of a continuum robot according to claim 3, characterized in that: In step 3 and step 22, the forces include the driving rope tension, friction, gravity and external load. The friction is divided into the friction between the driving rope and the rope hole and the friction at the joint; the gravity includes the gravity of the disc, the flexible rod, the driving rope and the wire lock; External loads include external torsion loads and force loads.
5. The static control method of a continuum robot according to claim 3, characterized in that: In step 22, in step 22, the point of application of the force is set to the center of the surface of a disk in front of each joint, the bending angle of the flexible rod is equal to the joint rotation angle, and its relationship with the torque is expressed based on Kirchhoff's elastic rod theory, wherein the bending angle of the flexible rod is equal to the ratio of the product of the torque and the rod length to the product of Young's modulus and the moment of inertia.
6. The statics control method of a continuum robot according to claim 3, characterized in that: The initial tension of all driving ropes is set to zero. After each driving force update, the nodes of each driving segment are recalculated based on the proposed kinematic statics model and gradually iterated to the target node.
7. The static control method of a continuum robot according to claim 1, characterized in that: The stiffness is the ratio of the small change in the driving force at the current position to the small displacement of the node in the direction of the driving rope.
8. The statics control method of a continuum robot according to claim 1, characterized in that: The base coordinate system is set at the zeroth joint one joint distance forward from the first joint, the Z axis is along the axial direction of the robot arm, the Y axis is vertically upward, and the set target node includes the X and Y coordinates.
9. The static control method of a continuum robot according to claim 1, characterized in that: When the error between the solved node position and the target node position is less than the set value, the iteration ends, and the tension and change length of each drive rope, as well as the position and posture of the robot arm, are output.
Citation Information
Patent Citations
Method and system for solving inverse kinematics of hyper-redundant robots on basis of sectioning geometric processes
CN106844951A
Rope-driven flexible mechanical arm and three-dimensional space statics modeling method thereof
CN112936271A
Precision compensation method for multi-degree-of-freedom snakelike mechanical arm
CN115741723A
Rigidity control and compensation method for continuum robot
CN115847389A
Wire drive continuum robot trajectory tracking method and device based on tension optimization
CN118357924A
Cited By
Composite continuum mechanical arm control method and system and mechanical arm
CN120347763A
A composite continuum robot arm control method, system and robot arm
CN120347763B
