CN113305809B - Force sense simulation control method of fully-constrained space rope driving parallel mechanism - Google Patents

Force sense simulation control method of fully-constrained space rope driving parallel mechanism Download PDF

Info

Publication number
CN113305809B
CN113305809B CN202110586409.6A CN202110586409A CN113305809B CN 113305809 B CN113305809 B CN 113305809B CN 202110586409 A CN202110586409 A CN 202110586409A CN 113305809 B CN113305809 B CN 113305809B
Authority
CN
China
Prior art keywords
rope
force
vector
model
platform
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110586409.6A
Other languages
Chinese (zh)
Other versions
CN113305809A (en
Inventor
陆思伊
何景峰
姜洪洲
佟志忠
张辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN202110586409.6A priority Critical patent/CN113305809B/en
Publication of CN113305809A publication Critical patent/CN113305809A/en
Application granted granted Critical
Publication of CN113305809B publication Critical patent/CN113305809B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1607Calculation of inertia, jacobian matrixes and inverses
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0078Programme-controlled manipulators having parallel kinematics actuated by cables
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1605Simulation of manipulator lay-out, design, modelling of manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Manipulator (AREA)

Abstract

The invention discloses a force sense simulation control method of a fully constrained space rope driven parallel mechanism, which comprises the following steps: step one, determining a motion calculation method; step two, solving a Jacobian matrix; step three, determining a tension distribution method; step four, establishing a dynamic model of the mechanism when the elasticity of the rope is considered; step five, building a closed-loop motion control frame; step six, determining a force sense simulation control scheme; and step seven, completing the construction of the overall control framework. The control frame of the invention is composed of three parts, which can ensure the good position tracking of the mobile platform, ensure the small and adjustable tension on the rope, and increase the man-machine interaction function of the rope parallel mechanism. In the specific control scheme, the dynamic performance of the mechanism is improved by introducing the internal force coordination ring, and the interaction with people is realized by introducing the force sense simulation ring. The force sensing simulation ring can be used or not according to the use requirement, and the rest two parts still have a good control effect.

Description

Force sense simulation control method of fully-constrained space rope driving parallel mechanism
Technical Field
The invention belongs to the technical field of control, and relates to a force sense simulation control method of a fully-constrained space rope driving parallel mechanism.
Background
The rope-driven parallel mechanism has the advantages of small mechanism mass, large movement space, small movement inertia, adjustable rigidity, strong load capacity and the like, is gradually concerned by numerous scholars, and the research and the start of China on the aspect of the rope parallel mechanism are late, so that the rope-driven parallel mechanism can be applied to numerous fields at present, for example: radio telescopes, wind tunnel tests, rehabilitation robots, industrial cameras, carrying assembly and the like. Due to the characteristic of unidirectional stress of the ropes, the mechanism needs to realize flexible control of n degrees of freedom, the number m of the ropes is equal to or larger than m and is larger than or equal to n +1, namely at least 7 ropes are needed for realizing control of six degrees of freedom, and in order to ensure the symmetry of the mechanism, 8 ropes are mostly adopted for realizing control of a full constraint space. When the rope is controlled to drive the parallel mechanism, the dynamic characteristics of the mechanism are involved, the mechanism is in redundant constraint, and the regulation of the internal force of the rope is also important. Secondly, enabling the mechanism to interact with people is a trend developed in the modern times, which puts higher requirements on the control framework of the rope-driven parallel mechanism, and the research on the control framework of the rope-driven parallel mechanism is very important.
Disclosure of Invention
In order to solve the problems, the invention provides a force sense simulation control method of a rope drive parallel mechanism in a fully constrained space. The rope mechanism has the characteristics of simple structure, large movement range and intrinsic safety, and can stably run on one hand and realize movement on a given track; on the other hand can interact with people, can make corresponding reaction to the force that the external world exerted, has realized the good control to two controlled variables of mechanism moving platform position and rope tension, can be used for simulating people and virtual object interactive power sense simultaneously.
The purpose of the invention is realized by the following technical scheme:
a force sense simulation control method of a fully-constrained space rope driving parallel mechanism comprises the following steps:
step one, determining a motion calculation method:
the motion calculation method considers the influence of the guide pulley on one hand, and solves the relation between the motor rotation angle and the rope length variation in the hoisting structure on the other hand, so that the rope is divided into two parts for analysis: the working space inner part and the driving system inner part solve the swing angle beta for the working space inner partiAngle of wrap alphaiCoordinates of rope outlet pointBSiFinally, the length l of the rope of the working space part is obtainedW,i(ii) a For the inner part of the driving system, obtaining an identity relation through the rope length states at two moments to solve the relation between the rotation angle of the motor and the rope length variable quantity, wherein:
(1) angle of oscillation betaiExpressed as:
Figure BDA0003087631480000021
in the formula,Bai,xthe component of the dynamic hinge point vector on the x axis of the global coordinate system is shown;Bai,ythe component of the dynamic hinge point vector on the y axis of the global coordinate system is shown;Bbi,xthe component of the vector of the tangent point of the swing axis of the guide pulley and the edge of the guide pulley on the x axis of the global coordinate system is shown;Bbi,ythe component of the vector of the oscillating axis of the guide pulley and the tangent point of the edge of the guide pulley on the y axis of the global coordinate system;
(2) wrap angle alphaiExpressed as:
αi=π-(αi,1i,2);
Figure BDA0003087631480000031
Figure BDA0003087631480000032
in the formula,Bmicentering the guide pulley in a global coordinate systemVector quantity;Bmi,zis the component of the guide pulley center vector on the z axis of the global coordinate system;Baithe vector of the movable hinge point in the global coordinate system is obtained;Bai,zthe component of the dynamic hinge point vector on the z axis of the global coordinate system is shown; ρ is the guide sheave radius.
(3) Coordinates of rope outlet pointBSiExpressed as:
Figure BDA0003087631480000033
in the formula,Bmi,xis the component of the guide pulley center vector on the x axis of the global coordinate system;Bmi,ythe component of the guide pulley center vector on the y axis of the global coordinate system is shown;
(4) rope length l of working space partW,iExpressed as:
lW,i=qP+lAS=ρ·αi+||Bai-BSi||2
in the formula, qPThe length of the rope wrapped on the guide pulley; lASThe length of the rope between the rope outlet point of the guide pulley and the movable hinge point is determined;
(5) the relationship between the motor rotation angle and the rope length variation is expressed as follows:
Figure BDA0003087631480000034
in the formula,. DELTA.lWIs the effective variation of the rope; h is the winding pitch of the rope;
Figure BDA0003087631480000036
is the motor corner; v. ofPGThe transmission ratio between the motor and the winch is set; r is the hoisting radius;
step two, solving a Jacobian matrix:
Figure BDA0003087631480000035
wherein J is a Jacobian matrix of the mechanism;BRPa rotation matrix of pose change between a global coordinate system and a body coordinate system; lnIs a unit rope length vector;Paiis the vector of the movable hinge point in the body coordinate system,BaiBRP Pai
step three, determining a tension distribution method:
the ropes were tension distributed using Closed-form theory:
fis=-J+Tw+fm-J+TJTfm
in the formula (f)isIs the rope tension; j. the design is a square+TIs the pseudo-inverse of the Jacobian matrix; w is an external force; f. ofmThe average value of the maximum value and the minimum value of the tension range;
step four, establishing a dynamic model of the mechanism in consideration of the elasticity of the rope:
assuming that the connections between the ropes and the mobile platform, between the ropes and the guide pulley, and between the ropes and the winch are all in an ideal state, based on the above assumptions, the dynamics modeling includes the mobile platform, the winch and the guide pulley, and the ropes, wherein:
(1) adopting a Newton Euler method to model a mobile platform:
Figure BDA0003087631480000041
wherein L is a matrix formed by unit direction vectors of each rope;Pa is a movable platform hinge point coordinate matrix; e is a 3 × 3 identity matrix; i is an inertia matrix of the movable platform relative to the fixed platform; omega is an antisymmetric matrix; m is the mobile platform mass; g is a gravity acceleration vector; f. of2iIs the platform side rope tension; t is the moving displacement of the movable platform relative to the fixed platform; ω and
Figure BDA0003087631480000043
for the angular speed and angle of rotation of the moving platform relative to the stationary platformAcceleration;
(2) a moment balance method is adopted to model a hoisting and guide pulley:
Figure BDA0003087631480000042
in the formula, JrEquivalent moment of inertia of the winch model and the pulley model;
Figure BDA0003087631480000044
the rotation angle vector of the ith motor; crAn equivalent damping coefficient matrix of a winch model and a pulley model; lambda [ alpha ]sThe equivalent radius of the winch model and the pulley model; f. of1iThe rope tension of the ith rope driving side; t isact,iIs the torque of the drive;
(3) modeling the rope as a spring damping model;
Figure BDA0003087631480000051
in the formula, ciFor the stiffness of the rope, diDamping for the rope; Δ liIs the deformation amount of the rope;
Figure BDA0003087631480000053
the rope deformation speed;
(4) the mathematical model of dynamics is:
Figure BDA0003087631480000052
wherein F is an external force acting on the mobile platform;
step five, building a closed-loop motion control framework:
the closed-loop motion control framework comprises a joint feedback-based motion control framework and a pose feedback-based motion control framework, wherein:
the motion control frame based on joint feedback and the motion control frame based on pose feedback both comprise an expected pose, moving platform pose feedback, winch corner feedback, internal force coordination, a motor driving system and a dynamic model with an elastic rope;
in the motion control frame based on joint feedback, the expected pose is solved through inverse kinematics to obtain the expected length variation of each rope, the result is converted into an expected motor corner, the expected motor corner is compared with the fed-back actual corner to obtain joint deviation, and the joint deviation is input into a PID controller to realize position control;
in the motion control frame based on pose feedback, a pose error is obtained by comparing an expected pose with a model measurement pose, a rope length error can be obtained according to a Jacobian matrix which is different between the rope length error and the pose error, the conversion from a task space error to a joint space error is realized, and then a rotation angle error of a motor is obtained and input into a PD controller to realize position control;
in the internal force coordination loop, expected tension is solved according to a tension distribution method, and the expected tension and rope tension obtained by model measurement form force internal loop feedback.
Step six, determining a force sense simulation control scheme:
the whole mechanism is equivalent to a mass-spring-damping system by adopting a force sense simulation ring, so that a transfer function between force and motion is obtained, external force is converted into position correction of a platform, the physical characteristics of the mechanism are changed by setting different parameter combinations, namely, a moving platform of the mechanism generates different motion state outputs under the action of the external force F, wherein:
the transfer function between force and motion is expressed as:
Figure BDA0003087631480000061
in the formula, MdIs equivalent mass; ddEquivalent damping is adopted; kdIs the equivalent stiffness; f is an external force acting on the mobile platform; e is the displacement correction of the mobile platform;
and seventhly, completing the construction of an integral control framework:
the overall control frame comprises at least two parts: a mobile platform position closed loop (two frames) and an internal force coordination loop; if the parallel mechanism needs to realize force sense simulation, the integral control frame also comprises a force sense simulation ring, and the step eight is executed;
and step eight, simulating different force senses and verifying the feasibility of human-computer interaction.
Compared with the prior art, the invention has the following advantages:
the control frame of the invention is composed of three parts, which can ensure the good position tracking of the mobile platform, ensure the small and adjustable tension on the rope, and increase the man-machine interaction function of the rope parallel mechanism. In the specific control scheme, the dynamic performance of the mechanism is improved by introducing the internal force coordination ring, and the interaction with people is realized by introducing the force sense simulation ring. The force sensing simulation ring can be used or not according to the use requirement, and the rest two parts still have a good control effect.
Drawings
FIG. 1 is an overall mechanical schematic;
FIG. 2 is an enlarged view of a portion of FIG. 1;
FIG. 3 is a schematic view of a closed vector of a rope in a workspace;
FIG. 4 is a schematic view of a cord drive;
FIG. 5 is a schematic view of the installation of the hoisting mechanism;
FIG. 6 is a block diagram of a kinetic model;
FIG. 7 is an overall control framework based on pose feedback;
FIG. 8 is an overall control framework based on joint feedback.
Detailed Description
The technical solution of the present invention is further described below with reference to the accompanying drawings, but not limited thereto, and any modification or equivalent replacement of the technical solution of the present invention without departing from the spirit and scope of the technical solution of the present invention shall be covered by the protection scope of the present invention.
The parallel mechanism is driven by eight ropes, the parallel mechanism is connected with a winch through a motor, the winch is wound with the ropes, the ropes are finally connected to a tail end executing mechanism, namely a mobile platform, through the guide of a guide pulley, the motion control of the tail end executing mechanism is completed through controlling the rotating angle of the motor, and a handle is arranged on the mobile platform of the parallel mechanism, so that the interaction between a person and the mechanism is facilitated. Fig. 1 and 2 are diagrammatic views of an overall mechanism with which a person can interact by holding the handle to move the platform. Fig. 4 is a schematic view of the complete transmission of a rope, and fig. 5 is a schematic view of the installation of a hoisting mechanism. The method comprises the following specific steps:
step 1: a motion solution method is determined.
The guide pulleys of the parallel mechanism can influence the rope length, and meanwhile, the transmission structure of the parallel mechanism can cause the rope length loosened by hoisting to be different from the rope length released at the tail end, so that the influence of the guide pulleys is considered on one hand, and on the other hand, the relationship between the motor rotation angle and the rope length variation in the structure is solved.
The rope drive diagram shown in fig. 4 was analyzed in two parts: the working space inner part (a hoisting rope outlet point C-a tangent point B of the guide pulley swinging shaft and the edge of the guide pulley) and the driving system inner part (a tangent point B of the guide pulley swinging shaft and the edge of the guide pulley-a movable hinge point A).
Firstly, a working space inner part: as shown in fig. 3, knowing the pulley radius ρ of the working space, the rope length in the working space is calculated by dividing the rope length into two parts, taking into account the influence of the pulley on the rope length: the first part is the length wrapped on the pulley, namely the arc length between the rope and two tangent points of the pulley, and the second part is the length between the exit rope point and the movable platform connecting point.
(1) Solving for the angle of oscillation betai
Figure BDA0003087631480000081
In the formula,Bai,xthe component of the dynamic hinge point vector on the x axis of the global coordinate system is shown;Bai,ythe component of the dynamic hinge point vector on the y axis of the global coordinate system is shown;Bbi,xfor the oscillating axle of the guide pulley and the edge of the guide pulleyThe component of the tangent point vector on the x-axis of the global coordinate system;Bbi,yis the component of the tangent point vector of the swing axis of the guide pulley and the edge of the guide pulley on the y axis of the global coordinate system.
(2) Solving for wrap angle alphai
Figure BDA0003087631480000091
In the formula,
Figure BDA0003087631480000098
a rotation matrix of the guide pulleys about the swing angle; e.g. of the typexIs a unit vector in the H coordinate system along the positive direction of the x axis, ex=[1 0 0]T
Angle of wrap alphaiCan be expressed as alphai=π-(αi,1i,2)。
Wherein,
Figure BDA0003087631480000092
(3) solving coordinates of rope outlet pointBSi
Figure BDA0003087631480000093
(4) Solving the rope length l of the working space partW,i
Adding the lengths of the two parts to obtainW,i=qP+lAS=ρ·αi+||Bai-BSi||2
In the formula, qPThe length of the rope wrapped on the guide pulley; lASThe length of the rope between the rope outlet point of the guide pulley and the movable hinge point is shown.
II, a driving system part: as shown in FIG. 4, s is the length of the straight line between the pulley in the driving system and the guide pulley in the working space, and can be turned by the winch
Figure BDA0003087631480000097
And the rope winding pitch h:
Figure BDA0003087631480000094
the rope length of hoisting and loosening is as follows:
Figure BDA0003087631480000095
in the form of a loose rear drive system
Figure BDA0003087631480000096
Effective variation of added rope Δ lWEqual to the internal length of the drive system before release plus the length to be released, as follows:
Figure BDA0003087631480000101
in the formula, cAAnd cBAs shown in FIG. 4 (c)AThe length of the rope from the rope outlet point of the winch to the tangent point of the rope and the left side of the pulley gamma, cBThe length of the rope wrapped on the pulley gamma); lW0,iThe length of the rope is the original length of the working space part.
Finishing to obtain:
Figure BDA0003087631480000102
step 2: the jacobian matrix is solved.
The Jacobian matrix can be used for describing the relation between the variable speed of the mechanism joint and the speed of the mobile platform and also describing the relation between the joint force and the stress of the tail end mobile platform, so that the Jacobian matrix is solved to lay a foundation for rope tension distribution and conversion from the joint variable to the tail end variable.
In pair type
Figure BDA0003087631480000103
Two sides are simultaneously derived and simplified:
Figure BDA0003087631480000105
ignoring the less influential terms, the above equation is simplified:
Figure BDA0003087631480000106
and step 3: a tension distribution method is determined.
The rope on the parallel mechanism has the characteristics of elasticity and unidirectional stress, the rope is ensured to be always in a tensioning state when the mobile platform moves, and the rope is subjected to tension distribution to ensure that the tension on the rope is within an expected range for the full-constraint mechanism.
The ropes were tension distributed using Closed-form theory:
f=-J+Tw+fm-J+TJTfm
wherein f is the rope tension; j. the design is a square+TIs the pseudo-inverse of the Jacobian matrix; w is an external force; f. ofmIs the average of the maximum and minimum values of the tension range.
And 4, step 4: a dynamic model of the mechanism is established taking into account the elasticity of the rope.
The rope-driven parallel mechanism researched by the invention does not need to bear larger load, and the moving platform has lighter weight. The connection between the rope and the moving platform, between the rope and the guide pulley, and between the rope and the winch are all assumed to be in an ideal state, namely, no friction force is generated in the mechanism. Based on the above assumptions, the dynamic modeling includes moving platforms, winches and guide sheaves, and ropes.
Moving platform dynamics: and establishing a dynamic model of the translation process of the terminal platform based on Newton's law, and establishing a dynamic model of the rotation process of the mobile platform based on Euler's equation.
Figure BDA0003087631480000111
Figure BDA0003087631480000112
Finishing to obtain:
Figure BDA0003087631480000113
hoisting and guide sheave dynamics: suppose JrEquivalent moment of inertia of the winch model and the pulley model;
Figure BDA0003087631480000114
a rotation angle vector of the ith motor, wherein the direction for extending the rope is defined as a positive direction; crAn equivalent damping coefficient matrix of a winch model and a pulley model; lambda [ alpha ]sThe equivalent radius of the winch model and the pulley model; f. of1iThe rope tension of the ith rope driving side; t isact,iIs the torque of the drive. Then the moment balances:
Figure BDA0003087631480000115
rope dynamics: the rope is equivalent to a spring damping model, and the rigidity of the rope is set to be ciAnd the damping of the rope is diThen, there are:
Figure BDA0003087631480000121
complete kinetics: when the mechanism interacts with the user, assuming that the force applied by the user is F, the overall mathematical model of the dynamics is,
Figure BDA0003087631480000122
the constructed dynamic simulation framework is shown in fig. 6.
And 5: and (5) building a closed-loop motion control framework.
The present invention provides two control frameworks: one motion control framework based on pose feedback and the other motion control framework based on joint feedback. The two frames comprise an expected pose, moving platform pose feedback, winch corner feedback, internal force coordination, a motor driving system and a dynamic model with an elastic rope, wherein:
the joint space control method includes the steps that expected rope length variable quantity of each rope is obtained through inverse kinematics solution from an expected pose, the result is converted into an expected motor corner, the expected motor corner is compared with a fed-back actual corner to obtain joint deviation, and the joint deviation is input into a PID controller to achieve position control;
the pose closed loop is a task space control method, a pose error is obtained by comparing an expected pose with a model measurement pose, a rope length error can be obtained according to a Jacobian matrix which is different between the rope length error and the pose error, the conversion from the task space error to a joint space error is realized, and then the rotation angle error of the motor is obtained and input into a PD controller to realize position control;
the control frame also comprises a rope tension control method, namely an internal force coordination loop, the expected tension is solved according to the tension distribution method, and the expected tension and the rope tension obtained by model measurement form force internal loop feedback.
In the invention, a motion control framework based on joint feedback is shown in fig. 7, an expected pose is calculated by inverse kinematics to obtain an expected length change delta l of each rope, the expected length change delta l is converted into an expected motor rotation angle according to the result obtained in the step 1, the expected motor rotation angle is compared with a fed-back actual rotation angle to obtain a joint deviation delta theta, the joint deviation delta theta is input into a PID (proportion integration differentiation) controller, and tension control adopts the tension distribution method in the step 3 to form force inner loop feedback.
In the invention, a motion control frame based on pose feedback is shown in fig. 8, the pose deviation delta q can be obtained by comparing an expected pose with a measurement pose, the rope length error delta l can be obtained as J.delta q according to a jacobian matrix which is different between the rope length error and the pose error, the conversion from a task space error to a joint space error is completed, the rotation angle error of a motor can be obtained and input into a PD controller to realize position control, and tension control adopts the tension distribution method in the step 3 to form force inner loop feedback.
In the invention, the two controls are both realized by outputting driving torque control mechanism motion through a motor driving system.
Step 6: and determining a force sense analog control scheme.
On the basis of realizing motion control, the invention also provides a control scheme for man-machine interaction, wherein the whole mechanism is equivalent to a mass-spring-damping system by adopting a force sense simulation ring, and the physical characteristics of the mechanism are changed by setting different parameter combinations, namely a moving platform of the mechanism can generate different motion state outputs under the action of an external force F. The transfer function between force and motion is:
Figure BDA0003087631480000131
the external force can be converted into the position correction amount of the platform.
In the invention, the rope tension sensor is adopted, when the mobile platform is acted by external force, the tension on the rope is inevitably changed, and the measured rope tension is converted into the external force through Jacobian matrix and stress analysis and then is input into the controller of the force sensing simulation ring.
Resultant w of forces other than rope tensionisCan be expressed as:
wis=-JTfis
in the formula (f)isIs the rope tension.
The inertia force is offset through stress analysis
Figure BDA0003087631480000141
And the gravity winitExternal force wadmExpressed as:
Figure BDA0003087631480000142
and 7: and finishing the construction of the overall control framework.
The overall control framework comprises three parts, namely a mobile platform position closed loop (two frameworks), an internal force coordination loop and a force sense simulation loop, as shown in fig. 7 and 8. If the mechanism does not need to realize force sense simulation, only the force sense simulation ring in the control frame needs to be removed, and the rest part can still realize good control on the mechanism.
And 8: and simulating different force senses to verify the feasibility of human-computer interaction.
By simulating several parameter setting situations, the feeling of force when a person interacts with a certain object in reality can be analogized, for example: the force sense of the situations of pushing a wall, pushing a box, beating a ball and the like can be simulated. The specific simulation scenario is as follows:
when the rigidity, the damping and the inertia exist, the mobile platform can show damping oscillation under the action of an instantaneous thrust and is finally stabilized at a balance position; when the damping is 0, the mobile platform can present an elastic effect, people can feel the force feeling when touching the spring, and the platform can be used for simulating a rubber ball; when the rigidity and the inertia are both 0, the mobile platform can show the following movement to the external force, when the external force is removed at a certain moment, the mobile platform can stop at the position where the force disappears, people can feel the force sense like pushing an object with light weight from one position to another position, and at the moment, the platform can be used for simulating a box; when the rigidity is 0, the mobile platform gradually moves away until stopping under the action of an instantaneous thrust, people can feel the force feeling when pushing away a boat on the water surface, and the platform can be used for simulating the boat on the water surface. When infinite rigidity and damping are set at a certain position, the platform cannot be moved under the action of continuously increasing external force, people can feel the force when the platform collides with a wall, and the platform can be used for simulating the wall.

Claims (6)

1. A force sense simulation control method of a rope-driven parallel mechanism in a fully-constrained space is characterized by comprising the following steps of:
step one, determining a motion calculation method:
the rope was divided into two parts for analysis: the working space inner part and the driving system inner part solve the swing angle beta for the working space inner partiAngle of wrap alphaiCoordinates of rope outlet pointBSiFinally, the length l of the rope of the working space part is obtainedW,i(ii) a For the part in the driving system, obtaining an identity relation through the rope length states at two moments to solve the relation between the motor rotation angle and the rope length variation;
step two, solving a Jacobian matrix:
the jacobian matrix is represented as:
J=[ln T (BRP Pai×ln)T];
wherein J is a Jacobian matrix of the mechanism;BRPa rotation matrix of pose change between a global coordinate system and a body coordinate system; lnIs a unit rope length vector;Paiis the vector of the movable hinge point in the body coordinate system,BaiBRP Pai
step three, determining a tension distribution method:
the ropes were tension distributed using Closed-form theory:
fis=-J+Tw+fm-J+TJTfm
in the formula (f)isIs the rope tension; j. the design is a square+TIs the pseudo-inverse of the Jacobian matrix; w is an external force; f. ofmThe average value of the maximum value and the minimum value of the tension range;
step four, establishing a dynamic model of the mechanism in consideration of the elasticity of the rope:
assuming that the connections between the ropes and the moving platform, between the ropes and the guide pulleys, and between the ropes and the winches are all in an ideal state, the mathematical model of the dynamics is expressed as:
Figure FDA0003526729300000021
wherein L is a matrix formed by unit direction vectors of each rope;Pa is a movable platform hinge point coordinate matrix; c. CiIs the stiffness of the rope; diDamping for the rope; Δ liIs the deformation amount of the rope;
Figure FDA0003526729300000023
the rope deformation speed; e is a 3 × 3 identity matrix; i is an inertia matrix of the movable platform relative to the fixed platform; omega is an antisymmetric matrix; m is the mobile platform mass; g is a gravity acceleration vector; t is the moving displacement of the movable platform relative to the fixed platform; ω and
Figure FDA0003526729300000022
the rotating angular velocity and the angular acceleration of the movable platform relative to the fixed platform are obtained; f is an external force acting on the mobile platform;
step five, building a closed-loop motion control framework:
the closed-loop motion control framework comprises a joint feedback-based motion control framework and a pose feedback-based motion control framework, wherein: the motion control frame based on joint feedback and the motion control frame based on pose feedback both comprise an expected pose, moving platform pose feedback, winch corner feedback, internal force coordination, a motor driving system and a dynamic model with an elastic rope;
step six, determining a force sense simulation control scheme:
the whole mechanism is equivalent to a mass-spring-damping system by adopting a force sense simulation ring, so that a transfer function between force and motion is obtained, external force is converted into position correction of a platform, and the physical characteristics of the mechanism are changed by setting different parameter combinations, namely the moving platform of the mechanism is subjected to external force FextDifferent motion state outputs are generated under the action;
and seventhly, completing the construction of an integral control framework:
the overall control frame comprises at least two parts: a mobile platform position closed loop and an internal force coordination loop.
2. The method for simulating and controlling the force sense of a rope-driven parallel mechanism in a fully constrained space as claimed in claim 1, wherein in the first step, the swing angle β isiAngle of wrap alphaiCoordinates of rope outlet pointBSiLength of rope in working spaceW,iAnd the relation between the motor rotation angle and the rope length variation is expressed as follows:
(1) angle of oscillation betai
Figure FDA0003526729300000031
In the formula,Bai,xthe component of the dynamic hinge point vector on the x axis of the global coordinate system is shown;Bai,ythe component of the dynamic hinge point vector on the y axis of the global coordinate system is shown;Bbi,xthe component of the vector of the tangent point of the swing axis of the guide pulley and the edge of the guide pulley on the x axis of the global coordinate system is shown;Bbi,ythe component of the vector of the oscillating axis of the guide pulley and the tangent point of the edge of the guide pulley on the y axis of the global coordinate system;
(2) wrap angle alphai
αi=π-(αi,1i,2);
Figure FDA0003526729300000032
Figure FDA0003526729300000033
In the formula,Bmithe vector of the center of the guide pulley in the global coordinate system is taken as the vector;Bmi,zis the component of the guide pulley center vector on the z axis of the global coordinate system;Baithe vector of the movable hinge point in the global coordinate system is obtained;Bai,zfor the vector of the pivot point in the z-axis of the global coordinate systemA component; rho is the radius of the guide pulley;
(3) coordinates of rope outlet pointBSi
Figure FDA0003526729300000034
In the formula,Bmi,xis the component of the guide pulley center vector on the x axis of the global coordinate system;Bmi,ythe component of the guide pulley center vector on the y axis of the global coordinate system is shown;
(4) rope length l of working space partW,i
lW,i=qP+lAS=ρ·αi+||Bai-BSi||2
In the formula, qPThe length of the rope wrapped on the guide pulley; lASThe length of the rope between the rope outlet point of the guide pulley and the movable hinge point is determined;
(5) the relationship between the motor rotation angle and the rope length variation is as follows:
Figure FDA0003526729300000041
in the formula,. DELTA.lWIs the effective variation of the rope; h is the winding pitch of the rope;
Figure FDA0003526729300000042
is the motor corner; v. ofPGThe transmission ratio between the motor and the winch is set; r is the hoisting radius.
3. The force sense simulation control method of the fully constrained space rope driven parallel mechanism according to claim 1, wherein in the fourth step, the dynamic modeling comprises a moving platform, a hoisting and guiding pulley and a rope, wherein:
(1) adopting a Newton Euler method to model a mobile platform:
Figure FDA0003526729300000043
in the formula (f)2iIs the platform side rope tension;
(2) a moment balance method is adopted to model a hoisting and guide pulley:
Figure FDA0003526729300000044
in the formula, JrEquivalent moment of inertia of the winch model and the pulley model;
Figure FDA0003526729300000045
the rotation angle vector of the ith motor; crAn equivalent damping coefficient matrix of a winch model and a pulley model; lambda [ alpha ]sThe equivalent radius of the winch model and the pulley model; f. of1iThe rope tension of the ith rope driving side; t isact,iIs the torque of the drive;
(3) modeling the rope as a spring damping model;
Figure FDA0003526729300000051
4. the force sense analog control method of the fully-constrained space rope-driven parallel mechanism according to claim 1, characterized in that in the fifth step, in a motion control frame based on joint feedback, the expected rope length variation of each rope is obtained by inverse kinematics solution from the expected pose, the result is converted into an expected motor rotation angle, and then the expected motor rotation angle is compared with the fed-back actual rotation angle to obtain joint deviation, and the joint deviation is input into a PID controller to realize position control; in a motion control frame based on pose feedback, comparing an expected pose with a model measurement pose to obtain a pose error, obtaining a rope length error according to a Jacobian matrix which is different from the rope length error and the pose error, realizing the conversion from a task space error to a joint space error, further solving a corner error of a motor and inputting the corner error into a PD controller to realize position control; in the internal force coordination loop, expected tension is solved according to a tension distribution method, and the expected tension and rope tension obtained by model measurement form force internal loop feedback.
5. The method for simulating and controlling the force sense of a rope-driven parallel mechanism in the fully constrained space according to claim 1, wherein in the sixth step, the transfer function between the force and the motion is expressed as:
Figure FDA0003526729300000052
in the formula, MdIs equivalent mass; ddEquivalent damping is adopted; kdIs the equivalent stiffness; and E is the displacement correction quantity of the movable platform.
6. The force sense simulation control method of the fully-constrained space rope-driven parallel mechanism according to claim 1, wherein in the seventh step, if the parallel mechanism needs to realize force sense simulation, the overall control frame further comprises a force sense simulation ring, and the eighth step is executed;
and step eight, simulating different force senses and verifying the feasibility of human-computer interaction.
CN202110586409.6A 2021-05-27 2021-05-27 Force sense simulation control method of fully-constrained space rope driving parallel mechanism Active CN113305809B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110586409.6A CN113305809B (en) 2021-05-27 2021-05-27 Force sense simulation control method of fully-constrained space rope driving parallel mechanism

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110586409.6A CN113305809B (en) 2021-05-27 2021-05-27 Force sense simulation control method of fully-constrained space rope driving parallel mechanism

Publications (2)

Publication Number Publication Date
CN113305809A CN113305809A (en) 2021-08-27
CN113305809B true CN113305809B (en) 2022-04-05

Family

ID=77375679

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110586409.6A Active CN113305809B (en) 2021-05-27 2021-05-27 Force sense simulation control method of fully-constrained space rope driving parallel mechanism

Country Status (1)

Country Link
CN (1) CN113305809B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114347005B (en) * 2022-03-18 2022-07-15 中国科学技术大学 Rope traction parallel robot continuous reconstruction planning method capable of avoiding obstacles
CN114367964B (en) * 2022-03-22 2022-07-15 中国科学技术大学 Reconstruction planning method for rope traction parallel robot
CN114643584B (en) * 2022-05-17 2022-09-30 中国科学技术大学 Rapid terminal sliding mode synchronous control method for rope traction parallel robot
CN114706312B (en) * 2022-06-06 2022-09-30 中国科学技术大学 High-precision self-adaptive cooperative control method for rope traction parallel robot
CN114933031A (en) * 2022-06-17 2022-08-23 北京航空航天大学 Multi-degree-of-freedom platform
CN115096496B (en) * 2022-06-23 2023-03-17 大连理工大学 Method for performing spatial six-dimensional force decoupling measurement by adopting cable drive mechanism
CN115096594B (en) * 2022-06-23 2023-09-19 大连理工大学 Device for loading and measuring space six-dimensional force by adopting cable driving mechanism

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107182271B (en) * 2011-12-16 2014-09-03 总装备部工程设计研究总院 Rope drive system pulling force and displacement self-adaptation control method in parallel
CN105974797A (en) * 2016-07-01 2016-09-28 厦门大学 Rope-driven parallel robot motion control method in consideration of elasticity effect and compensation
CN107009348A (en) * 2017-04-18 2017-08-04 中国科学技术大学 A kind of multi-configuration rope driving parallel robot and its spatial pose method for solving
CN107414811A (en) * 2017-06-30 2017-12-01 深圳市波心幻海科技有限公司 Two phase flow parallel connection impedance driver and robot and control method
CN108748091A (en) * 2018-05-21 2018-11-06 哈尔滨工业大学 Rope driving gravity compensation system in parallel towards big reachable tree and rope driving unit via Self-reconfiguration Method
CN109724482A (en) * 2019-01-07 2019-05-07 哈尔滨工业大学 A kind of reusable rocket landing Work condition analogue equipment for driving parallel robot based on rope
CN110450135A (en) * 2019-07-30 2019-11-15 华中科技大学鄂州工业技术研究院 A kind of dynamic suspension type weight support system
CN111400917A (en) * 2020-03-18 2020-07-10 中国科学技术大学 Kinematics optimization solving method of rope traction parallel robot with variable structure

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
PL2326288T3 (en) * 2008-05-20 2016-09-30 Device and method for decreasing energy consumption of a person by use of a lower extremity exoskeleton
CN104647367B (en) * 2014-12-29 2016-05-25 合肥工业大学 The robot palletizer in parallel of the compound driving of a kind of rope bar
US10639785B2 (en) * 2015-05-18 2020-05-05 The Regents Of The University Of California Variable force generators for arm supporting exoskeletons

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107182271B (en) * 2011-12-16 2014-09-03 总装备部工程设计研究总院 Rope drive system pulling force and displacement self-adaptation control method in parallel
CN105974797A (en) * 2016-07-01 2016-09-28 厦门大学 Rope-driven parallel robot motion control method in consideration of elasticity effect and compensation
CN107009348A (en) * 2017-04-18 2017-08-04 中国科学技术大学 A kind of multi-configuration rope driving parallel robot and its spatial pose method for solving
CN107414811A (en) * 2017-06-30 2017-12-01 深圳市波心幻海科技有限公司 Two phase flow parallel connection impedance driver and robot and control method
CN108748091A (en) * 2018-05-21 2018-11-06 哈尔滨工业大学 Rope driving gravity compensation system in parallel towards big reachable tree and rope driving unit via Self-reconfiguration Method
CN109724482A (en) * 2019-01-07 2019-05-07 哈尔滨工业大学 A kind of reusable rocket landing Work condition analogue equipment for driving parallel robot based on rope
CN110450135A (en) * 2019-07-30 2019-11-15 华中科技大学鄂州工业技术研究院 A kind of dynamic suspension type weight support system
CN111400917A (en) * 2020-03-18 2020-07-10 中国科学技术大学 Kinematics optimization solving method of rope traction parallel robot with variable structure

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
A Portable Intuitive Haptic Device on a Desk for User-Friendly Teleoperation of a Cable-Driven Parallel Robot;Park, JH;《APPLIED SCIENCES-BASEL》;20210523;全文 *
Kinematics Modeling of Rigid and Flexible Parallel Joint Mechanisms Driven by Rope;YiTao Pan;《2018 IEEE International Conference on Information and Automation (ICIA)》;20190826;全文 *
Modal space decoupled controller for hydraulically driven six degree of freedom parallel robot;Peter O. Ogbobe;《2010 2nd International Conference on Mechanical and Electronics Engineering》;20100826;全文 *
基于Lagrange方程的3RPS/UPS冗余驱动并联机构柔顺控制;崔学良;《计算机集成制造系统》;20161031;全文 *
绳系并联支撑机构的绳迟滞效应及影响实验研究;冀洋锋;《工程力学》;20191130;全文 *
考虑被动关节阻尼的液压驱动Stewart平台模态空间控制策略;田体先;《华南理工大学学报(自然科学版)》;20150630;全文 *

Also Published As

Publication number Publication date
CN113305809A (en) 2021-08-27

Similar Documents

Publication Publication Date Title
CN113305809B (en) Force sense simulation control method of fully-constrained space rope driving parallel mechanism
Sun et al. Nonlinear motion control of complicated dual rotary crane systems without velocity feedback: Design, analysis, and hardware experiments
Shang et al. Adaptive cross-coupled control of cable-driven parallel robots with model uncertainties
Liu et al. Design and analysis of spring parallel variable stiffness actuator based on antagonistic principle
CN104400783B (en) Tension force and joint position feedback flexible driving unit for robot joint control method
CN105974797A (en) Rope-driven parallel robot motion control method in consideration of elasticity effect and compensation
Kurazume et al. A new index of serial-link manipulator performance combining dynamic manipulability and manipulating force ellipsoids
CN110561425B (en) Rope-driven flexible robot force and position hybrid control method and system
Seo et al. Vibration reduction of flexible rope-driven mobile robot for safe facade operation
CN107121930B (en) Six Degree-of-Freedom Parallel Platform motion control method based on dummy model
You et al. Dynamic control of a 3-DOF cable-driven robot based on backstepping technique
Zhu et al. Dynamic characteristics of series-parallel hybrid rigid-flexible coupling double-mass underactuated system on floating platform
CN111496840B (en) Multi-degree-of-freedom variable-rigidity robot joint based on integral tensioning structure and working method thereof
CN116968057A (en) Parallel rope drives balanced control system
Zhang et al. High-precision adaptive control of cable-driven parallel robots with convergence guarantee
Wu et al. Controller design based on viscoelasticity dynamics model and experiment for flexible drive unit
Habib Nezhad Korayem et al. Trajectory optimization of cable parallel manipulators in point-to-point motion
Sander et al. Design of a new torso-joint for the humanoid robot ARMAR
Bang et al. Control and evaluation of a humanoid robot with rolling contact knees
Zhu et al. Optimization design and dynamic stability analysis of 3-DOF cable-driven parallel robot with an elastic telescopic rod
Lee et al. Façade operation robot on convex surface using an embedded rope ascender
Zhao et al. Dynamic Analysis and Trajectory Solution of Multi-Robot Coordinated Towing System
Tian et al. Cable-driven legged landing gear for unmanned helicopter: Prototype design, optimization and performance assessment
You et al. Tension distribution algorithm of a 7-DOF cable-driven robotic arm based on dynamic minimum pre-tightening force
Asano Motion generation of crawling-like locomotion robot composed of two identical units with passive wobbling mass and its extension to paper feeding

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant