Evaluation method for force pose stability of eight-cable and six-degree-of-freedom flexible cable driven parallel robot

By constructing a force position stability evaluation method for parallel robots with 8-core and 6-degree of freedom flexible cables, the problem of volatile instability and strong coupling effects of robots under external interference is solved, and a stability evaluation model is provided, which improves the stability of robots' attitude Sex and motor control ability.

CN119017358APending Publication Date: 2024-11-26XIAN UNIV OF SCI & TECH

Patent Information

Application Number
CN202411177406.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-26
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

The 8-core, 6-degree of freedom flexible cable-driven parallel robot is prone to instability under external interference, and the strong coupling effect between the flexible cable-drive system and the end effect leads to difficulty in stability evaluation, making it difficult to maintain the stability of the robot's posture.

Method used

By establishing a 8-core and 6-degree of freedom flexible cable-driven parallel robot force position stability evaluation method, the influencing factors are studied and the stability evaluation model is constructed, including kinematic diagrams, static equilibrium equations, redundant driving force optimization solution model and pose Influence function, calculate the minimum flexible cable driving force and stability impact factor, and provide stability evaluation indicators.

Benefits of technology

The influence factor of the stability of the soft cable-driven parallel robot is effectively analyzed, providing motion trajectory planning and control reference, and improving the stability and motion control ability of the robot under different postures.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119017358A_ABST
    Figure CN119017358A_ABST
Patent Text Reader

Abstract

The invention relates to the field of flexible cable driven parallel robots, in particular to a force pose stability evaluation method for an 8-cable and 6-degree-of-freedom flexible cable driven parallel robot. Influence factors and an influence mechanism which influence the stability of the flexible cable driven parallel robot are analyzed from the three aspects of the position of a working space where the mass center of an end effector of the 8-cable and 6-degree-of-freedom flexible cable driven parallel robot is located, flexible cable driving force in the weakest constraint direction and the posture of the end effector of the robot. The force pose stability evaluation method is provided, and then reference is provided for ensuring and improving the stability of the eight-cable and six-degree-of-freedom flexible cable driven parallel robot, robot trajectory planning and motion control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of flexible cable driven parallel robots, and in particular to a method for evaluating the force and posture stability of a flexible cable driven parallel robot with 8 cables and 6 degrees of freedom. Background Art

[0002] The cable-driven parallel robot uses flexible ropes to drive the end effector to move. It has many advantages such as large working space, strong carrying capacity, fast movement speed, and strong reconfigurability. It has been effectively applied in astronomical observation, medical rehabilitation training robots, marine cable-driven parallel rust removal robots, and coal gangue sorting robots. The point-mass cable-driven parallel robot drives the change of the center of mass of the robot end effector through several cables hinged at the same point on the end effector. It is difficult to meet the occasions where there is a demand for the spatial posture of the robot end effector. For example, the cable-driven coal gangue sorting robot requires the robot end effector to have an adjustable posture according to the shape and posture of the target gangue to adapt to the automatic sorting of the optimal grasping posture of the target gangue with different shapes and postures. The 8-cable 6-DOF cable-driven parallel robot realizes the change of the control position and posture of the end effector through the coordinated retraction and release of 8 driving cables. It can adapt to many occasions where there are requirements for the posture of the robot end effector, and this configuration has the significant advantages of large carrying capacity and large working space. However, there are two key problems in the theoretical research and application of 8-cable 6-DOF cable-driven parallel robots:

[0003] (1) Large flexibility constraints make it difficult to maintain stability. The large flexibility and unidirectional constraint characteristics of the cable make it easy for the cable-driven parallel robot to deviate from its original equilibrium state under external interference. Therefore, how to maintain the stability of the robot under external interference becomes the primary key problem.

[0004] (2) Strong coupling effect leads to difficulty in modeling. The 8-cable 6-DOF cable-driven parallel robot achieves changes in the spatial position and posture of the end effector by coordinating the retraction and extension of the cables. As a constraint on the robot's end effector, the cable drive system has an important impact on the stability of the robot's end effector; conversely, changes in the robot's end effector's posture will inevitably affect the stability of the cable drive system. Therefore, the 8-cable 6-DOF cable-driven parallel robot has a strong coupling effect between the cable drive system and the end effector, which poses a severe challenge to the establishment of the robot's stability evaluation model.

[0005] The unidirectional constraint characteristics of the flexible cable and the coupling effect of the cable drive system and the stability of the end effector make stability evaluation a key and challenging issue in the theory and application of the flexible cable driven parallel robot. In order to solve the above two problems, it is necessary to deeply study the main factors and their influencing mechanisms that affect the stability of the 8-cable 6-DOF flexible cable driven parallel robot, establish a robot stability evaluation model, and provide theoretical guidance to ensure the maintenance and further improvement of the robot's stability.

[0006] It is well known that when the robot end effector is in a balanced posture, the cable driving force is a necessary condition to maintain the stability of the robot. In addition, when the minimum cable driving force is less than a certain value, the cable may relax, resulting in the loss of the ability to control the robot end effector. Therefore, when the end effector is in a given balanced posture, a minimum cable driving force that meets certain conditions is required to stabilize the end effector. At the same time, the position, posture and cable driving force of the end effector have an important influence on the stability of the cable-driven parallel robot. Summary of the invention

[0007] To solve the above problems, the present invention provides a force and posture stability evaluation method for an 8-cable and 6-degree-of-freedom cable-driven parallel robot by studying the position, posture and cable driving force influencing factors that affect the stability of the 8-cable and 6-degree-of-freedom cable-driven parallel robot, which provides a reference for the motion trajectory planning and motion control of the 8-cable and 6-degree-of-freedom cable-driven parallel robot.

[0008] To achieve the above object, the technical solution adopted by the present invention is:

[0009] A method for evaluating the force and posture stability of an 8-cable 6-DOF flexible cable-driven parallel robot comprises the following steps:

[0010] S1. According to the kinematic diagram of the 8-cable 6-DOF cable-driven parallel robot, a global coordinate system O-XYZ is established, where O is the origin of the global coordinate system, and a local coordinate system o-xyz is established at the mass center of the end effector, where o is the origin of the local coordinate system; then, in the global coordinate system O-XYZ and the local coordinate system o-xyz, according to the kinematic model of the 8-cable 6-DOF cable-driven parallel robot, the unit vector in the length direction of the i-th cable is obtained, and then the angle between the direction of the cable with the minimum driving force at any position point of the robot end effector in the workspace and the horizontal plane is obtained; specifically:

[0011] Assume that the i-th flexible cable is wound on the drum, and the cable outlet on the pulley is A. i Point B is connected to the end effector of the robot. i Point, the i-th flexible cable is at A i and B i The straight line between them is denoted by ρi ; Point A i The coordinates in the global coordinate system are represented by vector a i Indicates: Point B i The coordinates in the local coordinate system are represented by vector b i The position of the end effector in the global coordinate system is represented by P = [x, y, z] T , the posture of the end effector in the global coordinate system is expressed as α = [φ, θ, ψ] T , then the spatial pose of the robot end effector is X = [x, y, z, φ, θ, ψ] T ; According to the kinematic model of the 8-cable 6-DOF cable-driven parallel robot, the unit vector in the length direction of the i-th cable is obtained

[0012] d i =(a i - O R o b i -P) / ρ i ,i=1,2,L,8, where

[0013] represents the rotation transformation matrix of the local coordinate system o-xyz relative to the global coordinate system O-XYZ, φ, θ and ψ are the rotation angles of the end effector coordinate system x, y, z axis relative to the global coordinate system X, Y, Z axis respectively; then the length ρ of the i-th flexible cable i =||a i - O R o b i -P||2,i=1,2,L,8, and then obtain the angle between the cable and the horizontal plane with the minimum driving force at any position of the robot end effector in the workspace a=arcsin(Hz) / ρ min , where ||·||2 represents the vector 2-norm; H is the height of the pulley tower; ρ min is the length of the cable with the minimum driving force when the robot end effector is at any position in the workspace;

[0014] S2. Use Newton-Euler method to establish the static equilibrium equation of the 8-cable 6-DOF cable-driven parallel robot: JT+W=0, where:

[0015] is the robot's structural matrix; T = [t1 t2 L t8] T is the cable driving force vector; W is the generalized external force vector acting on the end effector;

[0016] S3. Establishing the optimization solution model of redundant flexible cable driving force: in, represents the arithmetic mean of the cable driving force vector T, T s,min is the minimum permissible force of the 8 flexible cables, T s,max The maximum permissible force of the driving force of the 8 flexible cables;

[0017] According to the redundant cable driving force optimization solution model, the cable driving force vector T acting on the end effector is obtained, and then the minimum component of the cable driving force vector T is calculated by the following formula:

[0018] T min =min(T)

[0019] Where min(·) represents the minimum component of the cable driving force vector T;

[0020] S4. Based on the kinematic model of the 8-cable 6-DOF cable-driven parallel robot and the redundant cable-driven force optimization solution model, two stability position influencing factors are proposed respectively. and And two factors affecting the driving force of the stability cable and It is used to describe the influence of the cable driving force on the stability of the robot end effector in the working space and in the direction of the weakest constraint.

[0021] S5. Use vector n i Each component along the coordinate axis represents the influence of the posture change of the robot end effector on the stability of the 8-cable 6-DOF cable-driven parallel robot, and the posture influence function f(φ,θ,ψ) is constructed. The posture influence function f(φ,θ,ψ) must have the following properties:

[0022] Property 1: The value range of the attitude influence function is the interval [0,1];

[0023] Property 2: As the attitude angle increases, the stability of the end effector of the cable-driven parallel robot at the current position decreases;

[0024] Property 3: Assuming that the current position of the robot end effector is (x, y, z, φ, θ, ψ), then the attitude angle (0, 0, 0) is the most stable situation when the end effector is at the current position. The maximum attitude angle (φ max ,θ max ,ψ max ) is the case where the stability of the end effector is the weakest when it is at the current position. The end effector of the robot is at the critical point of instability. Therefore, the stability of the cable-driven parallel robot at the maximum attitude angle is 0; the stability of the end effector in other attitudes is between the above two cases, that is, the interval [0,1];

[0025] S6, based on stability position influence factor and Influencing factors of cable driving force and And the robot end effector posture influence function f(φ,θ,ψ), the force posture stability evaluation index of the 8-cable 6-DOF cable-driven parallel robot is proposed, which is expressed by the formula:

[0026]

[0027] Where X is the spatial three-dimensional position of the robot end effector; T = [t1 t2 L t8] T is the driving force vector of the 8-cable; p i1 and p i2 is the weight coefficient; f(φ,θ,ψ) is the posture influence function.

[0028] Furthermore, in step S4, two stability position influencing factors are proposed based on the robot kinematic model: and They are expressed as follows:

[0029]

[0030] Among them, α P , α Q and α M are the angles between the cable and the horizontal plane when the center of mass of the robot end effector is at positions P, Q and M respectively, with the minimum driving force; position point P is the position of the center of mass of the end effector in the workspace; position point Q is the intersection of the horizontal plane where the center of mass of the end effector position point P is located and the vertical midline a; position point M is the intersection of the vertical midline a and the top surface of the robot task space;

[0031] Based on the optimization solution model of the robot's flexible cable driving force, two influencing factors of the stable flexible cable driving force are proposed. and They are expressed as follows:

[0032]

[0033] Among them, T P,min 、T Q,min and T M,min are the driving forces of the weakest cables among the 8 cables.

[0034] Furthermore, the following selection principles are applied to the weight coefficients: i1 +p i2 =1, i=1,2.

[0035] Furthermore, the posture influence function f(φ,θ,ψ) adopts the following function:

[0036]

[0037] In the formula, and Represents vectors O R o n i and n i The ratio of the three axis components; O R o n i It means that when the three attitude angles of the end effector are all 0, the gravity center line of the end effector and the i-th connecting line n i The distance between.

[0038] The present invention has the following beneficial effects:

[0039] The influencing factors and their influencing mechanisms of the stability of the 8-cable 6-DOF cable-driven parallel robot are analyzed from three aspects: the position of the center of mass of the end effector in the workspace, the cable driving force in the weakest constraint direction, and the posture of the robot end effector. A force-posture stability evaluation method is proposed, which provides a reference for the motion trajectory planning and motion control of the 8-cable 6-DOF cable-driven parallel robot. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] Figure 1 This is a kinematic diagram of an 8-cable, 6-DOF cable-driven parallel robot.

[0041] Figure 2 Schematic diagram of the relationship between the stability position influencing factor and the stability cable driving force influencing factor in an embodiment of the present invention.

[0042] Figure 3 Schematic diagram of posture influence function. DETAILED DESCRIPTION

[0043] In order to make the purpose and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not intended to limit the present invention.

[0044] The embodiment of the present invention provides a method for evaluating the force and posture stability of an 8-cable 6-DOF cable-driven parallel robot, comprising the following steps:

[0045] S1. According to the kinematic diagram of the 8-cable 6-DOF cable-driven parallel robot, a global coordinate system O-XYZ is established, and a local coordinate system o-xyz is established at the mass center of the end effector, where O is the origin of the global coordinate system and o is the origin of the local coordinate system; Figure 1As shown in the figure, in the 8-cable 6-DOF cable-driven parallel robot, the i-th cable is wound on the drum and passes through the cable outlet A on the pulley. i Point B connected to the robot end effector i Assume that the i-th flexible cable is at A i and B i The straight line between them is denoted by ρ i ; Point A i The coordinates in the global coordinate system are represented by vector a i Indicates: Point B i The coordinates in the local coordinate system are represented by vector b i The position of the end effector in the global coordinate system is represented by P = [x, y, z] T , the posture of the end effector in the global coordinate system is expressed as α = [φ, θ, ψ] T , then the spatial pose of the robot end effector is X = [x, y, z, φ, θ, ψ] T .

[0046] According to the kinematic model of the 8-cable 6-DOF cable-driven parallel robot, the unit vector d in the length direction of the i-th cable is obtained. i =(a i - O R o b i -P) / ρ i ,i=1,2,L,8, where O R o Represents the rotation transformation matrix of the local coordinate system o-xyz relative to the global coordinate system O-XYZ, which is calculated by the following formula:

[0047]

[0048] Where φ, θ and ψ are the rotation angles of the x, y, and z axes of the end-effector coordinate system relative to the X, Y, and Z axes of the global coordinate system, respectively;

[0049] Then the length of the i-th cable ρ i =||a i - O R o b i -P||2,i=1,2,L,8, and then obtain the angle between the cable and the horizontal plane with the minimum driving force at any position of the robot end effector in the workspace a=arcsin(Hz) / ρ min , where ||·||2 represents the vector 2-norm, H is the height of the pulley tower; ρ min is the length of the cable with the minimum driving force when the robot end effector is at any position in the workspace;

[0050] S2. Use Newton-Euler method to establish the static equilibrium equation of 8-cable driven parallel robot JT+W=0; where, is the robot's structural matrix; T = [t1 t2 L t8] T is the cable driving force vector; W is the generalized external force vector acting on the end effector;

[0051] In order to prevent the cables from pulling the end effector virtually and breaking, the range of the driving force of the eight cables is given as follows: T s,min £T£T s,max , where T s,min is the minimum allowable value of the cable driving force, T s,max is the maximum allowable value of the cable driving force;

[0052] S3. Establishing the optimization solution model of redundant flexible cable driving force: in, It represents the arithmetic mean of the cable driving force vector T. According to the redundant cable driving force optimization solution model, the cable driving force vector T acting on the end effector is obtained, and then the minimum component of the cable driving force vector T is calculated by the following formula:

[0053] T min =min(T) (1)

[0054] In the formula, min(·) represents the minimum component of the cable driving force vector;

[0055] S4. Based on the kinematic model of the 8-cable 6-DOF cable-driven parallel robot and the redundant cable-driven force optimization solution model, two stability position influencing factors and two stability cable-driven force influencing factors are proposed to describe the influence of the cable-driven force of the robot end effector in the workspace position and the weakest constraint direction on the stability of the end effector; specifically:

[0056] like Figure 2 As shown in the figure, the cube is the task space of the 8-cable 6-DOF cable-driven parallel robot; the position of the mass center of the end effector in the workspace is represented by point P; the vertical center line of the robot task space is represented by a; the intersection of the horizontal plane where the mass center point P of the end effector is located and the vertical center line a is represented by Q; the intersection of the vertical center line a and the top surface of the robot task space is represented by M; when the robot end effector is located at positions P, Q and M respectively, the driving force of the weakest cable among the 8 cables is represented by T P,min ,T Q,min and T M,min Indicated by; when the center of mass of the robot end effector is at position points P, Q and M respectively, the angle between the cable with the minimum driving force and the horizontal plane is α P , α Qand α M express.

[0057] Based on the robot kinematics model, two stability position influencing factors are proposed and They are expressed as follows:

[0058]

[0059] Based on the optimization solution model of the robot's flexible cable driving force, two influencing factors of the stable flexible cable driving force are proposed. and They are expressed as follows:

[0060]

[0061] S5. Construct a posture influence function f(φ,θ,ψ) to characterize the influence of the end effector posture change on the stability of the 8-cable 6-DOF cable-driven parallel robot. The posture influence function f(φ,θ,ψ) must have the following properties:

[0062] Property 1: The range of the attitude influence function is the interval [0,1], so that the stability of the 8-cable 6-DOF cable-driven parallel robot can be evaluated using the interval [0,1].

[0063] Property 2: As the attitude angle increases, the stability of the end effector of the cable-driven parallel robot at its current position decreases.

[0064] Property 3: Assuming that the current posture of the robot end effector is (x, y, z, φ, θ, ψ), two extreme cases should be discussed: (i) the posture angle is (0, 0, 0), which is the most stable situation when the end effector is at the current position. In fact, this situation is the stability evaluation without considering the influence of posture on the stability of the cable-driven parallel robot; (ii) the maximum posture angle (φ max ,θ max ,ψ max ) is the case where the stability of the end effector is the weakest when it is at the current position. The end effector of the robot is at the critical point of instability. Therefore, the stability of the cable-driven parallel robot at the maximum attitude angle is 0. When the robot is at the current position, the stability of the end effector in other attitudes is between the above two cases, that is, the interval [0,1].

[0065] S6, based on stability position influence factor and Influencing factors of cable driving force and And the robot end effector posture influence function f(φ,θ,ψ), the force posture stability evaluation index of the 8-cable 6-DOF cable-driven parallel robot is proposed, which is expressed by the formula:

[0066]

[0067] Where X is the spatial three-dimensional position of the robot end effector; T is the cable driving force vector; p i1 and p i2 is the weight coefficient. The following selection principles apply to the weight coefficient: satisfy p i1 +p i2 =1, i=1,2; f(φ,θ,ψ) is the attitude influence function.

[0068] Based on the robot posture influence function diagram, when the three posture angles of the end effector are all 0°, the center of mass of the end effector is connected to the two hinge points B connecting the two adjacent cables and the end effector. i-1 With B i The perpendicular line between the two lines is n i For an 8-cable 6-DOF cable-driven parallel robot, there are 8 connecting lines and 8 vectors n i , and the 8 connecting lines form a spatial polygon. In general, the center of gravity of the robot end effector is within the spatial polygon. When the end effector is located at any position in the workspace, the robot is most stable when the three attitude angles of the end effector are all 0. Therefore, the three attitude angles of the end effector are all 0, which can be used as a benchmark for evaluating the stability of the robot. When the end effector has a non-zero attitude angle, the robot has weaker stability. When the attitude angle of the robot end effector changes, the vector n i Each component along the coordinate axis will change. As the attitude angle increases, the end effector center of gravity line may exceed the space polygon, causing the robot to become unstable. In addition, the shortest distance between the end effector center of gravity line and the space polygon characterizes the stability of the robot. Therefore, the vector n is used i Each component along the coordinate axis characterizes the influence of the posture change of the robot end effector on the stability of the 8-cable 6-DOF cable-driven parallel robot, and a robot posture influence function f(φ,θ,ψ) is proposed. In this embodiment, the posture influence function f(φ,θ,ψ) adopts the following function:

[0069]

[0070] In the formula, and Represents vectors O R o n i and n i The ratio of the three axis components; O Ro n i It means that when the three attitude angles of the end effector are all 0, the gravity center line of the end effector and the i-th connecting line n i The distance between.

[0071] like Figure 3 As shown, in the above posture influence function f(φ,θ,ψ):

[0072] The range of is the interval [0,1]; therefore, the range of the attitude influence function is also the interval [0,1], and Property 1 is proved.

[0073] As the attitude angle of the robot end effector increases, will decrease accordingly; therefore, the attitude influence function will decrease with the increase of the attitude angle of the end effector, that is, with the increase of the attitude angle, the stability of the end effector of the cable-driven parallel robot at the current position will decrease, and Property 2 is proved.

[0074] When the three attitude angles of the robot's end effector are (0,0,0), the value of the attitude influence function f(φ,θ,ψ) is 1, so the end effector is most stable when it is at the current position; as the three attitude angles of the robot's end effector increase, the center of gravity of the end effector is outside the stable polygon, when the cable-driven parallel robot is at the maximum attitude angle, the value of the attitude influence function f(φ,θ,ψ) is 0. At this time, the end effector is at the position with the weakest stability, the robot is in an unstable state, and is unstable. Property 3 is proved.

[0075] In summary, the attitude influence function of the end effector attitude change on the stability of the cable-driven parallel robot is taken as It can satisfy the three properties required by the attitude influence function, so it is reasonable.

[0076] From the above analysis, it can be seen that the value ranges of the robot posture influence function f(φ,θ,ψ), the position influence factor and the cable driving force influence factor are all in the interval [0,1]. Therefore, the value range of the force posture stability evaluation method proposed in this application is also in the interval [0,1]. Therefore, the force posture stability evaluation method proposed in this application can use the value between the interval [0,1] to quantify the stability of the 8-cable 6-DOF cable-driven parallel robot.

[0077] The above is only a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principle of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.

Claims

1. A method for evaluating the force and posture stability of an 8-cable 6-DOF cable-driven parallel robot, characterized in that: The steps include: S1. According to the kinematic diagram of the 8-cable 6-DOF cable-driven parallel robot, a global coordinate system O-XYZ is established, and a local coordinate system o-xyz is established at the mass center of the end effector; then, in the global coordinate system O-XYZ and the local coordinate system o-xyz, according to the kinematic model of the 8-cable 6-DOF cable-driven parallel robot, the unit vector in the length direction of the i-th cable is obtained, and then the angle between the direction of the cable with the minimum driving force at any position point of the robot end effector in the workspace and the horizontal plane is obtained; S2. Use Newton-Euler method to establish the static equilibrium equation of 8-cable 6-DOF cable-driven parallel robot: JT+W=0, where J is the structure matrix of the robot; T=[t1 t2 L t8] T is the cable driving force vector; W is the generalized external force vector acting on the robot end effector; S3. Establishing the optimization solution model of redundant flexible cable driving force: in, represents the arithmetic mean of the cable driving force vector T, T s,min is the minimum permissible force of the 8 flexible cables, T s,max is the maximum allowable force of the 8 flexible cable driving forces; according to the redundant flexible cable driving force optimization solution model, the flexible cable driving force vector T acting on the end effector is obtained, and then the minimum component of the flexible cable driving force vector T is calculated by the following formula: T min =min(T) Where min(·) represents the minimum component of the cable driving force vector T; S4. Based on the kinematic model of the 8-cable 6-DOF cable-driven parallel robot and the redundant cable-driven force optimization solution model, two stability position influencing factors are proposed respectively. and And two factors affecting the driving force of the stability cable and It is used to describe the influence of the cable driving force on the stability of the robot end effector in the working space and in the direction of the weakest constraint. S5. Use vector n i Each component along the coordinate axis represents the influence of the posture change of the robot end effector on the stability of the 8-cable 6-DOF cable-driven parallel robot, and the posture influence function f(φ, θ, ψ) is constructed. The posture influence function f(φ, θ, ψ) must have the following properties: Property 1: The value range of the attitude influence function is the interval [0,1]; Property 2: As the attitude angle increases, the stability of the end effector of the cable-driven parallel robot at the current position decreases; Property 3: Assuming that the current position of the robot end effector is (x, y, z, φ, θ, ψ), then the attitude angle (0, 0, 0) is the most stable situation when the end effector is at the current position point, and the maximum attitude angle (φ max ,θ max ,ψ max ) is the case where the stability of the end effector is the weakest when it is at the current position. The end effector of the robot is at the critical point of instability. Therefore, the stability of the cable-driven parallel robot at the maximum attitude angle is 0; the stability of the end effector in other attitudes is between the above two cases, that is, the interval [0,1]; S6, based on stability position influence factor and Influencing factors of cable driving force and And the robot end effector posture influence function f(φ, θ, ψ), the force posture stability evaluation index of the 8-cable 6-DOF cable-driven parallel robot is proposed, which is expressed by the formula: Where X is the spatial three-dimensional position of the robot end effector; T = [t1 t2 L t8] T is the driving force vector of the flexible cable; p i1 and p i2 is the weight coefficient; f(φ, θ, ψ) is the posture influence function.

2. The method for evaluating force and posture stability of an 8-cable 6-DOF cable-driven parallel robot according to claim 1, characterized in that: In step S1, it is assumed that the i-th flexible cable is wound on the drum, and the cable outlet on the pulley through the flexible cable is A i Point B is connected to the end effector of the robot. i Point, the i-th flexible cable is at A i and B i The straight line between them is denoted by ρ i ; Point A i The coordinates in the global coordinate system are represented by vector a i Indicates: Point B i The coordinates in the local coordinate system are represented by vector b i The position of the end effector in the global coordinate system is represented by P = [x, y, z] T , the posture of the end effector in the global coordinate system is expressed as α = [f, q, y] T , then the spatial pose of the robot end effector is X = [x, y, z, f, q, y] T .

3. The method for evaluating force and posture stability of an 8-cable 6-DOF cable-driven parallel robot according to claim 1, characterized in that: In step S1, the unit vector d in the length direction of the i-th flexible cable is obtained according to the kinematic model of the 8-cable 6-DOF flexible cable-driven parallel robot. i =(a i - O R o b i -P) / ρ i ,i=1,2,L,8, where O R o represents the rotation transformation matrix of the local coordinate system o-xyz relative to the global coordinate system O-XYZ; then the length of the i-th flexible cable ρ i =||a i - O R o b i -P||2,i=1,2,L,8, and then obtain the angle α=arcsin(Hz) / ρ between the direction of the cable with the minimum driving force at any position point in the workspace of the robot end effector and the horizontal plane min , where ||·||2 represents the vector 2-norm; H is the height of the pulley tower; ρ min It is the length of the cable with the minimum driving force when the robot end effector is at any position in the workspace.

4. The method for evaluating force and posture stability of an 8-cable 6-DOF cable-driven parallel robot according to claim 1, characterized in that: In step S4, two stability position influencing factors are proposed based on the robot kinematic model: and They are expressed as follows: Among them, α P , α Q and α M are the angles between the cable and the horizontal plane when the center of mass of the robot end effector is at positions P, Q and M respectively, with the minimum driving force; position point P is the position of the center of mass of the end effector in the workspace; position point Q is the intersection of the horizontal plane where the center of mass of the end effector position point P is located and the vertical midline a; position point M is the intersection of the vertical midline a and the top surface of the robot task space; Based on the optimization solution model of the robot's flexible cable driving force, two influencing factors of the stable flexible cable driving force are proposed. and They are expressed as follows: Among them, T P,min 、T Q,min and T M,min are the driving forces of the weakest cables among the 8 cables.

5. The method for evaluating force and posture stability of an 8-cable 6-DOF cable-driven parallel robot according to claim 1, characterized in that: The following selection principles are used for weight coefficients: i1 +p i2 =1, i=1,2.

6. The method for evaluating force and posture stability of an 8-cable 6-DOF cable-driven parallel robot according to claim 1, characterized in that: The posture influence function f(φ, θ, ψ) adopts the following function: In the formula, and Represents vectors O R o n i and n i The ratio of the three axis components; O R o n i It means that when the three attitude angles of the end effector are all 0, the gravity center line of the end effector and the i-th connecting line n i The distance between.

Citation Information

Patent Citations

  • Method for evaluating motion stability of flexible cable-driven rock picking robot

    CN107122568A

  • Triune structure stability evaluation method for rope tractive parallel robot

    CN107813342A

  • Under-constrained rope traction parallel mechanism stability analysis method

    CN112632768A

  • Method for planning motion along trajectory of end of hyper-redundant mechanical arm

    WO2021184655A1

Cited By

  • Wheel-legged unmanned platform dynamic overturning stability determination method and system

    CN122688933A