CN114367964B - Reconstruction planning method for rope traction parallel robot - Google Patents

Reconstruction planning method for rope traction parallel robot Download PDF

Info

Publication number
CN114367964B
CN114367964B CN202210280216.2A CN202210280216A CN114367964B CN 114367964 B CN114367964 B CN 114367964B CN 202210280216 A CN202210280216 A CN 202210280216A CN 114367964 B CN114367964 B CN 114367964B
Authority
CN
China
Prior art keywords
rope
parallel robot
leading
points
reconstruction
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
CN202210280216.2A
Other languages
Chinese (zh)
Other versions
CN114367964A (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.)
University of Science and Technology of China USTC
Original Assignee
University of Science and Technology of China USTC
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 University of Science and Technology of China USTC filed Critical University of Science and Technology of China USTC
Priority to CN202210280216.2A priority Critical patent/CN114367964B/en
Publication of CN114367964A publication Critical patent/CN114367964A/en
Application granted granted Critical
Publication of CN114367964B publication Critical patent/CN114367964B/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/003Programme-controlled manipulators having parallel kinematics
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/104Programme-controlled manipulators characterised by positioning means for manipulator elements with cables, chains or ribbons

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

The invention discloses a reconstruction planning method for a rope traction parallel robot, which comprises the following steps: step 1, setting a coordinate system and parameters of a rope traction parallel robot, and respectively establishing a dynamic equation of a movable platform and a single rope leading-out device; step 2, establishing a mathematical model corresponding to the force feasible working space according to the parameters; step 3, planning a track of the movable platform and dispersing the track into a path point set of the movable platform, and combining a mathematical model corresponding to the feasible working space to determine the relation between the feasible working space of the current configuration and the path of the movable platform; step 4, judging whether an optimal configuration exists; and 5, setting an objective function which minimizes the number of the moving rope leading-out points in the continuous reconstruction, and solving a rope leading-out point position sequence in the continuous reconstruction, namely finishing the reconstruction planning of the rope traction parallel robot. The method carries out planning reconstruction by adjusting to the optimal configuration and implementing a continuous reconstruction mode, and the number of the moving rope leading-out points is minimum, thereby saving energy.

Description

Reconstruction planning method for rope traction parallel robot
Technical Field
The invention relates to the field of rope traction parallel robots, in particular to a reconstruction planning method of a rope traction parallel robot.
Background
The rope traction parallel robot has the advantages of large working space, high load-weight ratio, easiness in assembly and layout and the like, but the fixed configuration of the rope traction parallel robot restricts the performance of the robot and is difficult to adapt to requirements of different tasks. Therefore, researchers have designed reconfigurable rope-towed parallel robots that increase mission flexibility by changing the location of the rope-to-fixed frame attachment points (referred to as rope exit points). At present, after a target configuration is obtained through optimization, reconstruction is achieved through manual operation before a task is executed, and the mode of offline assembly again hinders the execution of the task and the improvement of production efficiency.
Although the chinese patent application 202010192426.7 and CN202010191743.7 disclose a kinematics optimization solution method for a rope traction parallel robot with a variable structure, the problem of reconstruction planning of the robot cannot be solved. The Chinese patent application 201910523043.0 discloses a self-reconfiguration planning method of a heterogeneous modular robot based on a reinforcement learning algorithm, but a rope traction parallel robot adopts rope drive, and the tension of the rope is unidirectional, so that the reconfiguration planning suitable for the modular robot cannot be applied to the rope traction parallel robot. In addition, the positions of all rope leading-out points need to be adjusted continuously in the continuous reconstruction process, so that not only is the energy consumption increased, but also the risk of collision with an obstacle is increased, therefore, under the condition of meeting the task requirements, the problem of how to minimize the number of the rope leading-out points needing to be moved in the continuous reconstruction process is also a concern, but the effective rope traction parallel robot reconstruction planning method is lacked at present.
In view of the above, the present invention is particularly proposed.
Disclosure of Invention
The invention aims to provide a reconstruction planning method for a rope traction parallel robot, which can plan the positions of rope leading-out points to realize the reconstruction of the rope traction parallel robot and minimize the number of the rope leading-out points needing to be moved in the continuous reconstruction process, thereby solving the technical problems in the prior art.
The purpose of the invention is realized by the following technical scheme:
the embodiment of the invention provides a reconstruction planning method for a rope traction parallel robot, which comprises the following steps:
step 1, setting a coordinate system and parameters of a rope traction parallel robot to be reconstructed and planned, and respectively establishing a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device according to the set coordinate system and parameters;
step 2, establishing a mathematical model corresponding to the feasible working space of the force of the rope-traction parallel robot according to the parameters of the rope-traction parallel robot;
step 3, planning a track of the movable platform and dispersing the track into a set of path points of the movable platform, determining the relation between the force feasible working space of the current configuration of the rope traction parallel robot and the path of the movable platform by combining a mathematical model corresponding to the force feasible working space, judging whether the force feasible working space of the current configuration completely comprises the path of the movable platform according to the mathematical model corresponding to the force feasible working space, if so, determining that the configuration does not need to be adjusted, and finishing the planning; if not, determining to trigger reconstruction, and executing the step 4;
step 4, judging whether the rope traction parallel robot has an optimal configuration, if so, finishing planning; if not, executing the step 5;
and 5, setting an objective function which minimizes the number of the moving rope leading-out points in the continuous reconstruction, solving a rope leading-out point position sequence of the rope traction parallel robot in the continuous reconstruction, and finishing the reconstruction planning of the rope traction parallel robot.
Compared with the prior art, the rope traction parallel robot reconfiguration planning method provided by the invention has the beneficial effects that:
by determining the relationship between the force feasible working space of the rope traction parallel robot and the movable platform path, the force feasible working space of the current configuration cannot completely contain the movable platform path as a trigger condition for the reconstruction of the rope traction parallel robot; when the reconfiguration is triggered, the method preferentially searches for an optimal configuration, the rope leading-out point can be automatically moved to an optimal position without disassembly and assembly, and then a driving motor of the rope leading-out point is in a locked state when the movable platform moves, so that no extra energy is consumed; when the optimal configuration can not meet the task, continuous reconstruction is carried out, the configuration reconstruction is automatically completed when the movable platform moves, the range of the feasible working space of force is dynamically adjusted, the path of the movable platform is always positioned in the feasible working space of force, and in the continuous reconstruction process, the number of the moved rope leading-out points can be minimized and the corresponding moving distance can be calculated by the method, so that the energy is saved.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required to be used in the description of the embodiments are briefly introduced below, and it is obvious that the drawings in the description below are only some embodiments of the present invention, and it is obvious for those skilled in the art that other drawings can be obtained according to the drawings without creative efforts.
Fig. 1 is a flowchart of a rope-traction parallel robot reconfiguration planning method according to an embodiment of the present invention.
Fig. 2 is a specific flowchart of a rope-traction parallel robot reconfiguration planning method according to an embodiment of the present invention.
Fig. 3 is a schematic structural diagram of a rope traction parallel robot according to an embodiment of the present invention.
Fig. 4 is a schematic view of a linear task path scene of a moving platform of a rope-traction parallel robot according to an embodiment of the present invention.
The part names corresponding to the marks in the figure are as follows: 11-a fixed frame; 12-rope take-off, 121-guide pulley, 122-slider; 13-a rope; 14-moving the platform; 15-a motor driving the lead screw; 16-a motor driving the drum; 17-a reel; 18-vertical lead screw.
Detailed Description
The technical scheme in the embodiment of the invention is clearly and completely described below by combining the specific content of the invention; it is to be understood that the described embodiments are merely exemplary of the invention, and are not intended to limit the invention to the particular forms disclosed. All other embodiments, which can be derived by a person skilled in the art from the embodiments of the present invention without making any creative effort, shall fall within the protection scope of the present invention.
The terms that may be used herein are first described as follows:
the term "and/or" means that either or both can be achieved, for example, X and/or Y means that both cases include "X" or "Y" as well as three cases including "X and Y".
The terms "comprising," "including," "containing," "having," or other similar terms of meaning should be construed as non-exclusive inclusions. For example: including a feature (e.g., material, component, ingredient, carrier, formulation, material, dimension, part, component, mechanism, device, step, process, method, reaction condition, processing condition, parameter, algorithm, signal, data, product, or article, etc.) that is not specifically recited, should be interpreted to include not only the specifically recited feature but also other features not specifically recited and known in the art.
The term "consisting of … …" is meant to exclude any technical feature elements not explicitly listed. If used in a claim, the term shall render the claim closed except for the usual impurities associated therewith which do not include the technical features other than those explicitly listed. If the term occurs in only one clause of the claims, it is defined only as specifically listed in that clause, and elements recited in other clauses are not excluded from the overall claims.
Unless otherwise expressly stated or limited, the terms "mounted," "connected," "secured," and the like are to be construed broadly, as for example: can be fixedly connected, can also be detachably connected or integrally connected; can be mechanically or electrically connected; they may be connected directly or indirectly through intervening media, or they may be interconnected between two elements. The specific meaning of the above terms herein can be understood by those of ordinary skill in the art as appropriate.
When concentrations, temperatures, pressures, dimensions, or other parameters are expressed as ranges of values, the ranges of values should be understood to specifically disclose all ranges formed by any pair of upper values, lower values, or preferred values within the range, regardless of whether the ranges are explicitly recited; for example, if a numerical range of "2 ~ 8" is recited, then the numerical range should be interpreted to include ranges of "2 ~ 7", "2 ~ 6", "5 ~ 7", "3 ~ 4 and 6 ~ 7", "3 ~ 5 and 7", "2 and 5 ~ 7", and the like. Unless otherwise indicated, the numerical ranges recited herein include both the endpoints thereof and all integers and fractions within the numerical range.
The terms "central," "longitudinal," "lateral," "length," "width," "thickness," "upper," "lower," "front," "rear," "left," "right," "vertical," "horizontal," "top," "bottom," "inner," "outer," "clockwise," "counterclockwise," and the like are used in an orientation or positional relationship that is indicated based on the orientation or positional relationship shown in the drawings for ease of description and simplicity of description only, and are not meant to imply or imply that the device or element so referred to must have a particular orientation, be constructed in a particular orientation, and be operated in a particular manner and therefore are not to be construed as limiting herein.
The rope traction parallel robot reconfiguration planning method provided by the invention is described in detail below. Details which are not described in detail in the embodiments of the invention belong to the prior art which is known to a person skilled in the art. Those not specifically mentioned in the examples of the present invention were carried out according to the conventional conditions in the art or conditions suggested by the manufacturer. The reagents or instruments used in the examples of the present invention are not specified by manufacturers, and are all conventional products available by commercial purchase.
As shown in fig. 1, an embodiment of the present invention provides a reconstruction planning method for a rope-towed parallel robot, where planning a position of a rope leading-out point to implement reconstruction of the rope-towed parallel robot includes:
step 1, setting a coordinate system and parameters of a rope traction parallel robot to be reconstructed and planned, and respectively establishing a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device according to the set coordinate system and parameters;
step 2, establishing a mathematical model corresponding to the feasible working space of the force of the rope-traction parallel robot according to the parameters of the rope-traction parallel robot;
step 3, planning a track of the movable platform and dispersing the track into a set of path points of the movable platform, determining the relation between the force feasible working space of the current configuration of the rope traction parallel robot and the path of the movable platform by combining a mathematical model corresponding to the force feasible working space, judging whether the force feasible working space of the current configuration completely comprises the path of the movable platform according to the mathematical model corresponding to the force feasible working space, if so, determining that the configuration does not need to be adjusted, and finishing the planning; if not, determining to trigger reconstruction, and executing the step 4;
step 4, judging whether the rope traction parallel robot has an optimal configuration, if so, finishing planning; if not, executing the step 5;
and 5, setting an objective function which minimizes the number of the moving rope leading-out points in the continuous reconstruction, solving a rope leading-out point position sequence of the rope traction parallel robot in the continuous reconstruction, and finishing the reconstruction planning of the rope traction parallel robot.
In step 1 of the method, a coordinate system and parameters of the rope traction parallel robot to be reconstructed and planned are set according to the following modes, and a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device are respectively established according to the set coordinate system and parameters, wherein the dynamic equation comprises the following steps:
setting global coordinate system of rope-traction parallel robot
Figure 167355DEST_PATH_IMAGE001
Of (2)
Figure 22178DEST_PATH_IMAGE002
A rope leading-out point which is positioned on the ground of the fixed frame of the rope-traction parallel robot and leads the rope to the parallel robot
Figure 988866DEST_PATH_IMAGE003
For position vector of
Figure 321759DEST_PATH_IMAGE004
It is shown that the process of the present invention,
Figure 323081DEST_PATH_IMAGE005
Figure 83227DEST_PATH_IMAGE006
the number of the leading-out points of the ropes and the number of the ropes are used for the position vector of the movable platform of the rope traction parallel robot
Figure 615840DEST_PATH_IMAGE007
Showing that the ropes pull the ropes of the parallel robots
Figure 4620DEST_PATH_IMAGE008
Is a direction vector of
Figure 876761DEST_PATH_IMAGE009
Establishing a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device;
the dynamic equation of the movable platform is as follows:
Figure 260338DEST_PATH_IMAGE010
(1);
in the formula (1), the reaction mixture is,
Figure 217930DEST_PATH_IMAGE011
a structural matrix corresponding to the parallel robot is towed by the rope,
Figure 141892DEST_PATH_IMAGE012
Figure 930857DEST_PATH_IMAGE013
a rope tension vector for the rope-towed parallel robot;
Figure 298384DEST_PATH_IMAGE014
the mass of a moving platform for the rope traction parallel robot;
Figure 992539DEST_PATH_IMAGE015
a moving platform acceleration for the rope-towed parallel robot;
Figure 205346DEST_PATH_IMAGE016
Figure 241960DEST_PATH_IMAGE017
is the acceleration of gravity;
the kinetic equation for the single rope lead-out device is:
Figure 780388DEST_PATH_IMAGE018
(2);
in the formula (2), the reaction mixture is,
Figure 696261DEST_PATH_IMAGE019
an axial driving force of a rope pulling-out device for pulling the parallel robot for the rope;
Figure 40654DEST_PATH_IMAGE020
a rope tension for said rope pulling parallel robots;
Figure 741894DEST_PATH_IMAGE021
Figure 700492DEST_PATH_IMAGE022
the weight of a rope take-off device that pulls the parallel robot for the rope;
Figure 792076DEST_PATH_IMAGE017
is the acceleration of gravity;
Figure 127111DEST_PATH_IMAGE023
acceleration of a rope lead-out device of the parallel robot is pulled for the rope.
In step 2 of the above method, the mathematical model established is:
Figure 745174DEST_PATH_IMAGE025
(3);
in the formula (3), the reaction mixture is,
Figure 625405DEST_PATH_IMAGE026
a structural matrix corresponding to the parallel robot is towed by the rope,
Figure 518800DEST_PATH_IMAGE012
Figure 80362DEST_PATH_IMAGE027
rope for pulling parallel robots for said ropeA tension vector;
Figure 739882DEST_PATH_IMAGE028
the rope pulls the dynamic platform of the parallel robot to bear the resultant external force;
Figure 791015DEST_PATH_IMAGE029
the lower limit of the rope tension vector is set to be 10N;
Figure 168776DEST_PATH_IMAGE030
the components are set to 200N for the upper limit of the rope tension vector.
In step 3 of the method, a movable platform track is planned and dispersed into a movable platform path point set in the following way, and a mathematical model corresponding to a binding force feasible working space determines the relation between the force feasible working space of the current configuration of the rope traction parallel robot and the movable platform path, including:
at the time of
Figure 658663DEST_PATH_IMAGE031
Planning the path of the moving platform by adopting a track planning algorithm to obtain the track
Figure 657843DEST_PATH_IMAGE032
Figure 394724DEST_PATH_IMAGE033
The trajectory is
Figure 948196DEST_PATH_IMAGE034
Figure 177794DEST_PATH_IMAGE035
According to a given time step
Figure 562639DEST_PATH_IMAGE036
Discretization into a set of moving platform waypoints
Figure 17891DEST_PATH_IMAGE037
Figure 776768DEST_PATH_IMAGE038
Figure 608458DEST_PATH_IMAGE031
Is composed of
Figure 97077DEST_PATH_IMAGE039
Integer multiples of;
converting the mathematical model formula (3) corresponding to the force feasible working space into an inequality by adopting a moving hyperplane method:
Figure 660914DEST_PATH_IMAGE040
(4);
in the above formula (4), matrix
Figure 438246DEST_PATH_IMAGE041
Sum vector
Figure 11309DEST_PATH_IMAGE042
Drawing a corresponding structural matrix of the parallel robot according to the rope by a moving hyperplane method
Figure 167484DEST_PATH_IMAGE043
Upper limit of rope tension vector
Figure 419999DEST_PATH_IMAGE030
Lower limit of rope tension vector
Figure 169780DEST_PATH_IMAGE029
Obtaining;
judging whether the force feasible working space of the current configuration of the rope-traction parallel robot completely contains a moving platform path according to the mathematical model corresponding to the force feasible working space in the following way, including:
determining a set of moving platform waypoints
Figure 795802DEST_PATH_IMAGE044
Whether each of the waypoints in the set is fullIf the inequality (4) is satisfied, determining that the feasible working space of the force of the current configuration of the rope-traction parallel robot completely contains a moving platform path without adjusting the configuration; and if not, determining that the force feasible working space of the current configuration of the rope traction parallel robot cannot completely contain the moving platform path, and triggering reconfiguration.
In step 4 of the method, whether the rope-traction parallel robot has an optimal configuration is judged according to the following modes, including:
setting the position of a rope leading-out point of the rope-traction parallel robot
Figure 744167DEST_PATH_IMAGE045
Between the upper and lower limits of position:
Figure 977702DEST_PATH_IMAGE046
(5);
in the above formula (5), lower limit of position
Figure 526364DEST_PATH_IMAGE047
(ii) a Upper limit of position
Figure 378913DEST_PATH_IMAGE048
Setting the first objective function as:
Figure 431052DEST_PATH_IMAGE049
(6);
in the formula (6), the reaction mixture is,
Figure 773171DEST_PATH_IMAGE050
capacity margin indexes for keeping the mobile platform away from the boundary of the power feasible working space;
-setting said inequality (4) and said inequality (5) as a first penalty function by means of a penalty function:
Figure 887758DEST_PATH_IMAGE051
(7);
in the formula (7), the reaction mixture is,
Figure 327354DEST_PATH_IMAGE052
is a penalty factor;
Figure 719152DEST_PATH_IMAGE053
is constrained by all inequalities;
Figure 294490DEST_PATH_IMAGE054
the number of inequality constraints;
adding the first penalty function of the formula (7) and the first objective function of the formula (6) to form a new objective function, solving the new objective function by adopting a competitive particle swarm algorithm to obtain an optimal configuration, determining that the rope traction parallel robot can be adjusted to a fixed optimal configuration if the optimal configuration has a solution, and finishing planning; if the optimization is solution-free, it is determined that there is no optimal configuration.
In step 4 of the above-described method,
Figure 817744DEST_PATH_IMAGE055
is set as
Figure 12096DEST_PATH_IMAGE056
The search space dimension of the competitive particle swarm algorithm is
Figure 304406DEST_PATH_IMAGE057
In step 5 of the above method, an objective function for minimizing the number of moving rope leading-out points in continuous reconstruction is set in the following manner, and a rope leading-out point position sequence of the rope traction parallel robot in continuous reconstruction is solved, including:
step 51, constructing the total displacement of the rope leading-out points into an indefinite linear equation set;
step 52, setting a rope leading-out point physical constraint condition and a second objective function which minimizes the number of the moved rope leading-out points in continuous reconstruction;
step 53, solving a speed sequence of rope index out-points in continuous reconstruction through a second objective function which minimizes the number of the moved rope out-points in the continuous reconstruction;
and 54, filtering the solved speed sequence of the rope leading-out points and smoothing to obtain a position sequence of the rope leading-out points.
In the step 51, the total rope leading-out point displacement is constructed into an indefinite linear equation set according to the following mode, which includes:
by using
Figure 316224DEST_PATH_IMAGE058
Representing and moving platform path point set
Figure 749611DEST_PATH_IMAGE059
In (1)
Figure 59238DEST_PATH_IMAGE060
Rope leading-out point corresponding to position of moving platform
Figure 19104DEST_PATH_IMAGE003
The initial position of the cord exit point
Figure 77190DEST_PATH_IMAGE061
The method is obtained by measuring the actually planned rope traction parallel robot;
by using
Figure 577966DEST_PATH_IMAGE062
Figure 238755DEST_PATH_IMAGE063
Representing the change in position of the cord exit point; by using
Figure 990810DEST_PATH_IMAGE064
Is shown in time
Figure 469065DEST_PATH_IMAGE065
Inner position
Figure 939360DEST_PATH_IMAGE066
And
Figure 325211DEST_PATH_IMAGE067
the speed of (d) in between; by using
Figure 994090DEST_PATH_IMAGE068
Figure 190716DEST_PATH_IMAGE005
Representing and moving platform path point set
Figure 397575DEST_PATH_IMAGE069
Corresponding rope leading-out point
Figure 275532DEST_PATH_IMAGE003
The speed sequence of (a);
the rope leading-out point of the rope traction parallel robot is at the total time
Figure 242659DEST_PATH_IMAGE031
Total displacement of internal movement
Figure 938082DEST_PATH_IMAGE070
Comprises the following steps:
Figure 117391DEST_PATH_IMAGE071
(8);
in the formula (8), the reaction mixture is,
Figure 313886DEST_PATH_IMAGE072
is one
Figure 895040DEST_PATH_IMAGE073
Vector of (2), solution in equation (8)
Figure 495785DEST_PATH_IMAGE074
Is not unique;
Figure 677237DEST_PATH_IMAGE075
is one
Figure 896997DEST_PATH_IMAGE076
A constant vector of (2);
in step 52, the setting of the physical constraint conditions for the rope exit points and the second objective function for minimizing the number of the moved rope exit points in the continuous reconstruction includes:
setting a rope leading-out point
Figure 847504DEST_PATH_IMAGE077
In the position of
Figure 619151DEST_PATH_IMAGE078
Speed, velocity
Figure 431774DEST_PATH_IMAGE079
Acceleration of the object
Figure 517541DEST_PATH_IMAGE080
Satisfy respective upper and lower limits:
Figure 135605DEST_PATH_IMAGE081
(9);
in the formula (9), the reaction mixture is,
Figure 530683DEST_PATH_IMAGE082
Figure 109563DEST_PATH_IMAGE083
Figure 982710DEST_PATH_IMAGE084
Figure 720859DEST_PATH_IMAGE085
(ii) a Setting a second objective function for minimizing the number of rope exit points moved in successive reconstructions as:
Figure 771991DEST_PATH_IMAGE086
(10);
in the formula (10), the reaction mixture is,
Figure 87435DEST_PATH_IMAGE087
the value range is 0 to 1 for weight;
Figure 249426DEST_PATH_IMAGE088
the number of the rope leading-out points is the number of the rope leading-out points;
Figure 107660DEST_PATH_IMAGE089
is a speed sequence of rope leading-out points;
Figure 581892DEST_PATH_IMAGE090
the number of the path points of the movable platform is;
Figure 197681DEST_PATH_IMAGE091
capacity margin indexes for moving the power platform away from the boundary of the power feasible working space;
in the step 53, solving a speed sequence of rope index points in the continuous reconstruction by using a second objective function which minimizes the number of the moving rope lead-out points in the continuous reconstruction includes:
-setting the inequality of said equation (4) and said equation (9) as a second penalty function by means of a penalty function, adding the second penalty function to a second objective function of said equation (10) as an overall objective function, the corresponding sequence of rope exit point positions being represented during the optimization iteration as:
Figure 350313DEST_PATH_IMAGE092
(11);
in the above-mentioned formula (11),
Figure 735158DEST_PATH_IMAGE093
for the initial known position of each rope leading-out point, solving a speed sequence of the rope leading-out points in the continuous reconstruction process by adopting a competitive particle swarm algorithm;
in step 54, the solved speed sequence of the rope leading-out points is filtered and smoothed to obtain a position sequence of the rope leading-out points, which includes:
setting a speed sequence for the exit point of a rope
Figure 455990DEST_PATH_IMAGE094
The filtration condition of each element in (1) is completely 0:
Figure 542763DEST_PATH_IMAGE095
(12);
in the above-mentioned formula (12),
Figure 312136DEST_PATH_IMAGE096
to obtain
Figure 738438DEST_PATH_IMAGE094
Then obtaining the position sequence of the rope leading-out points through the formula (11); and smoothing by adopting a spline curve to obtain a position sequence of the rope leading-out points.
In the above-mentioned method, the first step of the method,
in the step 52, the process is carried out,
Figure 567854DEST_PATH_IMAGE097
set to 0.995;
in said step 53, in a second penalty function
Figure 486131DEST_PATH_IMAGE055
Is set as
Figure 983496DEST_PATH_IMAGE056
In the step 53, the search space dimension of the competitive particle swarm optimization is
Figure 342934DEST_PATH_IMAGE098
In the above method, the reconstructed planned rope-towed parallel robot includes:
fixingA frame,
Figure 405568DEST_PATH_IMAGE057
A rope leading-out device,
Figure 466933DEST_PATH_IMAGE057
A vertical screw rod,
Figure 781371DEST_PATH_IMAGE099
A motor,
Figure 244582DEST_PATH_IMAGE057
A winding drum,
Figure 478118DEST_PATH_IMAGE057
A rope and a movable platform, wherein the rope is arranged on the movable platform,
Figure 777512DEST_PATH_IMAGE057
is a positive integer; wherein,
each rope leading-out device consists of a sliding block and a guide pulley, and the guide pulley is connected and arranged on the sliding block and can synchronously move along with the sliding block;
Figure 613750DEST_PATH_IMAGE057
the vertical screw rods are arranged in the fixed frame in a surrounding manner, each vertical screw rod is provided with a sliding block of a rope leading-out device, one end of each vertical screw rod is connected with a motor, and the vertical screw rods can rotate under the driving of the motors and drive the sliding blocks to move up and down;
Figure 947779DEST_PATH_IMAGE057
the winding drums are arranged on the ground in the fixed frame in a surrounding manner, one winding drum is arranged below each vertical screw rod, a rope is wound on each winding drum, each winding drum is connected with a motor, and the winding drums can rotate under the driving of the motors to wind and release the connected ropes;
the other end of each rope is connected with the movable platform after sequentially passing around a guide pulley of a rope leading-out device above the rope, and each rope suspends the movable platform in the fixed frame.
In step 3 of the method, the trajectory planning algorithm adopts any one of a trapezoidal trajectory planning algorithm and a sigmoid trajectory planning algorithm. Other conventional trajectory planning algorithms may also be employed.
In step 4 of the method, the optimal configuration of the rope traction parallel robot is a fixed configuration, the position of the rope leading-out point is adjusted before the movable platform moves, the optimal configuration is adjusted, and the position of the rope leading-out point is not changed any more when the movable platform moves.
In step 5 of the method, the continuous reconstruction is that the position of the rope leading-out point is automatically adjusted according to the change of the path of the movable platform in the moving process of the movable platform.
In summary, according to the method provided by the embodiment of the invention, by analyzing the relationship between the force feasible working space of the rope-towed parallel robot and the movable platform path, the force feasible working space of the current configuration cannot completely contain the movable platform path as the trigger condition for reconstructing the rope-towed parallel robot. When the reconfiguration is triggered, the method preferentially searches for the optimal configuration, the rope leading-out point can be automatically moved to the optimal position without disassembly and assembly, and then a driving motor of the rope leading-out point is in a locked state when the movable platform moves, so that extra energy is not consumed. When the optimal configuration can not meet the task, continuous reconstruction is carried out, configuration reconstruction is automatically completed when the movable platform moves, the range of the feasible working space of force is dynamically adjusted, the path of the movable platform is always positioned in the feasible working space of force, and in the continuous reconstruction process, the number of the moved rope leading-out points can be minimized and the corresponding moving distance can be calculated by the method, so that the energy is saved.
In order to more clearly show the technical solutions and the technical effects provided by the present invention, the reconfiguration planning method for a rope-traction parallel robot provided by the embodiment of the present invention is described in detail with specific embodiments below.
Example 1
The embodiment provides a reconstruction planning method for a rope traction parallel robotThe rope traction parallel robot structure reconstructed and planned by the method is shown in fig. 3 and comprises the following steps: a fixed frame,
Figure 352216DEST_PATH_IMAGE057
A rope leading-out device,
Figure 402822DEST_PATH_IMAGE057
A vertical screw rod,
Figure 793483DEST_PATH_IMAGE057
A rope is arranged,
Figure 231287DEST_PATH_IMAGE099
An electric motor: (
Figure 478728DEST_PATH_IMAGE057
A motor for driving the screw rod and
Figure 736403DEST_PATH_IMAGE057
a motor for driving the drum),
Figure 55389DEST_PATH_IMAGE057
A winding drum and a movable platform, wherein the winding drum is arranged on the movable platform,
Figure 98432DEST_PATH_IMAGE057
is a positive integer; the rope leading-out device mainly comprises a sliding block and a rope guide pulley;
Figure 969304DEST_PATH_IMAGE057
the motor drives each vertical screw rod distributed in the fixed frame to rotate, so that a sliding block of the rope leading-out device is driven to move up and down, the position of a guide pulley arranged on the sliding block is changed, and the rope pulls the parallel robot to reconstruct; in addition, the
Figure 465008DEST_PATH_IMAGE057
The motors are connected with and distributed on the ground winding drums in the fixed frame, and one winding drum is arranged below each vertical screw rod and used for winding and unwinding the ropeRope; global coordinate system
Figure 587685DEST_PATH_IMAGE100
Of (2)
Figure 737431DEST_PATH_IMAGE101
The fixed frame is positioned on the ground; the rope from the reel end is connected with the movable platform after passing through the guide pulley
Figure 529937DEST_PATH_IMAGE102
The radius of the guide pulley is small relative to the total working space and can be reduced to a point, whereby the rope is considered to be drawn off from the rope exit point
Figure 27784DEST_PATH_IMAGE103
Figure 360676DEST_PATH_IMAGE104
) At the point of exit, the cord
Figure 175048DEST_PATH_IMAGE103
In that
Figure 918882DEST_PATH_IMAGE105
The position of the direction is fixed, and the direction is fixed,
Figure 389178DEST_PATH_IMAGE106
the change of the direction position represents the change of the configuration of the rope traction parallel robot.
The specific steps of the reconstruction planning method are shown in fig. 2, and include:
step 1, establishing a dynamic equation of a movable platform and a rope leading-out device according to a set coordinate system and parameters of the rope traction parallel robot. Bringing out a rope of the robot
Figure 588078DEST_PATH_IMAGE003
For position vector of
Figure 709487DEST_PATH_IMAGE004
It is shown that the process of the present invention,
Figure 109375DEST_PATH_IMAGE005
Figure 53585DEST_PATH_IMAGE006
the number of the rope leading-out points and the number of the ropes are used as the position vector of the movable platform of the robot
Figure 321755DEST_PATH_IMAGE007
Show, rope
Figure 48403DEST_PATH_IMAGE008
Has a direction vector of
Figure 868460DEST_PATH_IMAGE009
The dynamic equation of the movable platform is as follows:
Figure 375665DEST_PATH_IMAGE010
(1);
in the above-mentioned formula (1),
Figure 119630DEST_PATH_IMAGE011
a corresponding structural matrix for the rope-towing parallel robot, wherein,
Figure 887735DEST_PATH_IMAGE012
Figure 691743DEST_PATH_IMAGE107
a rope tension vector for the rope-towed parallel robot;
Figure 420664DEST_PATH_IMAGE108
the mass of the moving platform for the rope traction parallel robot;
Figure 217588DEST_PATH_IMAGE015
a moving platform acceleration of the rope-towed parallel robot;
Figure 122090DEST_PATH_IMAGE016
Figure 893737DEST_PATH_IMAGE109
is the acceleration of gravity;
the kinetic equation for a single rope takeoff is:
Figure 565414DEST_PATH_IMAGE018
(2);
in the above-mentioned formula (2),
Figure 588865DEST_PATH_IMAGE021
,
Figure 393879DEST_PATH_IMAGE110
Figure 336427DEST_PATH_IMAGE022
and
Figure 977624DEST_PATH_IMAGE111
respectively representing the axial driving force, weight and acceleration of the rope lead-out means,
Figure 54033DEST_PATH_IMAGE112
is the rope tension.
Step 2, establishing a mathematical model of the force feasible working space: according to the parameters in the step 1, the mathematical model of the force feasible working space of the rope traction parallel robot is as follows:
Figure 464286DEST_PATH_IMAGE025
(3);
in the above-mentioned formula (3),
Figure 843315DEST_PATH_IMAGE011
a structural matrix corresponding to the parallel robot is towed by the rope,
Figure 221075DEST_PATH_IMAGE012
Figure 851908DEST_PATH_IMAGE107
is the rope tension vector;
Figure 444563DEST_PATH_IMAGE029
the lower limit of the tension vector is set to be 10N;
Figure 172655DEST_PATH_IMAGE030
the upper limit of the tension vector is set as 200N;
Figure 460548DEST_PATH_IMAGE028
the movable platform is stressed by external force;
step 3, planning a track of the movable platform, dispersing the track into a set of path points of the movable platform, and analyzing the relation between the feasible working space of the current configuration and the path of the movable platform: at the time of
Figure 941077DEST_PATH_IMAGE113
Planning the path of the movable platform shown in FIG. 4 by using conventional trajectory planning algorithm (such as trapezoidal and S-shaped) to obtain trajectory
Figure 388238DEST_PATH_IMAGE114
(
Figure 46753DEST_PATH_IMAGE033
) According to a given time step
Figure 336789DEST_PATH_IMAGE036
Discretization into a set of moving platform waypoints
Figure 106162DEST_PATH_IMAGE037
Figure 407830DEST_PATH_IMAGE038
Figure 486513DEST_PATH_IMAGE115
Is composed of
Figure 748998DEST_PATH_IMAGE036
Integer multiples of; converting the mathematical model formula (3) into an inequality by adopting a mobile hyperplane method:
Figure 308680DEST_PATH_IMAGE040
(4);
in the above formula (4), matrix
Figure 668117DEST_PATH_IMAGE041
Sum vector
Figure 730751DEST_PATH_IMAGE116
Can be obtained according to the mobile hyperplane method, both of which are related to the rope-traction parallel robot configuration. Determining a set of moving platform waypoints
Figure 792117DEST_PATH_IMAGE044
Whether each path point meets an inequality (4) or not is judged, if yes, the feasible working space of the current configuration completely contains the path of the movable platform, the configuration does not need to be adjusted, and planning is finished; if not, determining that the force feasible working space of the current configuration cannot completely contain the moving platform path (namely, the reconstruction triggering condition is met), triggering reconstruction, and continuing to perform the step 4.
Step 4, judging whether an optimal configuration exists: setting the position of the cord exit point
Figure 637713DEST_PATH_IMAGE045
Between the upper and lower limits of position:
Figure 38608DEST_PATH_IMAGE046
(5);
in the above-mentioned formula (5),
Figure 209826DEST_PATH_IMAGE047
Figure 492909DEST_PATH_IMAGE048
(ii) a To ensure the robustness of the force balance, the first objective function is set as:
Figure 470092DEST_PATH_IMAGE049
(6);
in the above-mentioned formula (6),
Figure 804121DEST_PATH_IMAGE050
moving the platform away from the boundary of the power feasible working space for capacity margin; -setting said inequality (4) and said inequality (5) as a first penalty function by means of a penalty function: :
Figure 336121DEST_PATH_IMAGE117
(7);
in the above-mentioned formula (7),
Figure 857233DEST_PATH_IMAGE052
in order to be a penalty factor,
Figure 638107DEST_PATH_IMAGE053
for the purpose of all the inequality constraints,
Figure 75910DEST_PATH_IMAGE054
the number of inequality constraints; adding said first penalty function (7) to the first objective function (6)
Figure 526614DEST_PATH_IMAGE118
Forming a new objective function
Figure 784289DEST_PATH_IMAGE119
Solving the optimal configuration by adopting a competitive particle swarm algorithm;
Figure 103275DEST_PATH_IMAGE052
is set as
Figure 146317DEST_PATH_IMAGE120
The search space dimension of the competitive particle swarm algorithm is equal to
Figure 17190DEST_PATH_IMAGE088
If the optimization has a solution, determining that the robot can be adjusted to a fixed optimal configuration, and finishing planning; if there is no solution, step 5 is started.
Step 5, setting an objective function which minimizes the number of moving rope leading-out points in continuous reconstruction, solving a rope leading-out point position sequence of the rope traction parallel robot in the continuous reconstruction, namely completing reconstruction planning of the rope traction parallel robot, wherein the step 5 comprises the following steps:
and step 51, expressing the total displacement of the rope leading-out points into the form of an indefinite linear equation set:
by using
Figure 778473DEST_PATH_IMAGE121
Figure 635571DEST_PATH_IMAGE122
Representing and moving platform path point set
Figure 50896DEST_PATH_IMAGE044
In
Figure 843403DEST_PATH_IMAGE123
Rope leading-out point corresponding to position of moving platform
Figure 75670DEST_PATH_IMAGE124
The initial position vector of the rope exit point
Figure 2037DEST_PATH_IMAGE125
The method is obtained by measuring the actually planned rope traction parallel robot;
by using
Figure 957355DEST_PATH_IMAGE126
Figure 232347DEST_PATH_IMAGE127
Indicating a change in the position of the cord exit point;
Figure 764960DEST_PATH_IMAGE128
to be at time
Figure 167122DEST_PATH_IMAGE129
Inner position
Figure 226214DEST_PATH_IMAGE130
And
Figure 422840DEST_PATH_IMAGE131
the speed of the motor;
by using
Figure 442749DEST_PATH_IMAGE132
Figure 912518DEST_PATH_IMAGE133
Representing and moving platform path point set
Figure 373587DEST_PATH_IMAGE134
Corresponding rope leading-out point
Figure 459223DEST_PATH_IMAGE135
The speed sequence of (a);
rope exit point in total time
Figure 638532DEST_PATH_IMAGE136
Total displacement of internal movement
Figure 631764DEST_PATH_IMAGE137
The corresponding system of indefinite linear equations is:
Figure 947339DEST_PATH_IMAGE138
(8);
in the above-mentioned formula (8),
Figure 938298DEST_PATH_IMAGE139
is one
Figure 604903DEST_PATH_IMAGE140
The vector of (a);
Figure 214875DEST_PATH_IMAGE141
is one
Figure 902733DEST_PATH_IMAGE142
A constant vector of (2); because of the fact that
Figure 815326DEST_PATH_IMAGE143
Solution in formula (8)
Figure 218494DEST_PATH_IMAGE144
Is not unique;
step 52, setting a rope leading-out point physical constraint condition and a second objective function which minimizes the number of the moved rope leading-out points in the continuous reconstruction: setting a rope leading-out point
Figure 366579DEST_PATH_IMAGE145
In the position of
Figure 922325DEST_PATH_IMAGE146
Speed of the motor
Figure 255086DEST_PATH_IMAGE147
Acceleration of the vehicle
Figure 630704DEST_PATH_IMAGE148
Satisfy respective upper and lower limits:
Figure 769430DEST_PATH_IMAGE149
(9);
in the above-mentioned formula (9),
Figure 507579DEST_PATH_IMAGE082
Figure 761974DEST_PATH_IMAGE083
Figure 142664DEST_PATH_IMAGE084
Figure 632551DEST_PATH_IMAGE085
(ii) a In order to reduce the number of rope leading-out points moving in the continuous reconstruction process of the robot, a second objective function for continuous reconstruction is set as follows:
Figure 162890DEST_PATH_IMAGE150
(10);
in the above-mentioned formula (10),
Figure 571874DEST_PATH_IMAGE087
the value range is 0 to 1 for weight;
Figure 187663DEST_PATH_IMAGE088
the number of the rope leading-out points is the number of the rope leading-out points;
Figure 481241DEST_PATH_IMAGE151
is a speed sequence of rope leading-out points;
Figure 115354DEST_PATH_IMAGE090
the number of the path points of the movable platform is;
Figure 711552DEST_PATH_IMAGE091
capacity margin indexes for moving the power platform away from the boundary of the power feasible working space;
Figure 532746DEST_PATH_IMAGE087
the larger the value is,
Figure 302119DEST_PATH_IMAGE152
the more the number of the middle zero elements is,
Figure 793667DEST_PATH_IMAGE087
the value is finely adjusted according to different tracks of the movable platform, wherein
Figure 685400DEST_PATH_IMAGE087
Set to 0.995; the first term in the second objective function is normalized by the norm L1
Figure 10202DEST_PATH_IMAGE153
The medium elements are characterized by sparsity and the like,
Figure 770217DEST_PATH_IMAGE151
the number of the non-zero elements is the least, so that the number of the zero elements is the most, and the number of the movable rope leading-out points is ensured to be the least; second term by adding capacity margin indicator
Figure 129654DEST_PATH_IMAGE154
The dynamic platform is far away from the boundary of the feasible working space of the force, so that the robustness of the force balance is ensured;
step 53, solving the speed sequence of rope index out-points in continuous reconstruction by using a second objective function which minimizes the number of the moved rope out-points in continuous reconstruction: setting the expression (4) and the expression (9) as a second penalty function through a penalty function method, and adding the second penalty function and the second objective function of the expression (10) to form an overall objective function, wherein in the optimization process, the corresponding rope outlet position sequences are as follows:
Figure 457867DEST_PATH_IMAGE092
(11);
in the above-mentioned formula (11),
Figure 456916DEST_PATH_IMAGE155
for each rope exit point an initial known location; because the competitive particle swarm algorithm is suitable for solving the global optimization problem of the high-dimensional search space, the competitive particle swarm algorithm is adopted to solve the overall objective function, so that the rope of the robot is pulledThe number of rope leading-out points moving in the continuous reconstruction process of the parallel robot is minimum; in a second penalty function
Figure 568091DEST_PATH_IMAGE052
Is set as
Figure 844352DEST_PATH_IMAGE120
(ii) a The search space dimension of the competitive particle swarm algorithm is
Figure 264838DEST_PATH_IMAGE156
Step 54, filtering the rope leading-out point speed sequence and smoothing the rope leading-out point position sequence: the L1 norm would be
Figure 501915DEST_PATH_IMAGE151
The medium elements present sparsity but are optimized
Figure 744678DEST_PATH_IMAGE151
Some of the element values are not completely 0 but infinitely inclined to 0, and in order to make the sparse characteristic more thoroughly appear, the following filtering conditions are set so that the sparse characteristic is more thoroughly expressed
Figure 788027DEST_PATH_IMAGE151
Wherein the elements are all 0:
Figure 130147DEST_PATH_IMAGE095
(12);
in the above-mentioned formula (12),
Figure 369367DEST_PATH_IMAGE157
(ii) a To obtain
Figure 150241DEST_PATH_IMAGE151
Then obtaining the position sequence of the rope leading-out points through the formula (11); due to the fact that
Figure 73198DEST_PATH_IMAGE158
And
Figure 773170DEST_PATH_IMAGE159
the set value is small, and the influence on the sequence of the rope leading-out point positions is negligible; and smoothing by adopting a spline curve to obtain a position sequence, namely finishing the reconstruction planning of the rope traction parallel robot.
In summary, compared with the prior art, the reconstruction planning method of the embodiment of the present invention at least has the following beneficial effects:
(1) by analyzing the relation between the feasible working space of the rope traction parallel robot and the task path of the movable platform, the feasible working space of the current configuration force cannot completely contain the path of the movable platform as a trigger condition for reconstructing the rope traction parallel robot, and the reconstruction motion of the rope traction parallel robot is planned by combining the physical constraints of the position, the speed, the acceleration and the like of a rope leading-out point and the rope tension constraint.
(2) The optimal configuration is selected preferentially, the rope leading-out point can be automatically moved to the optimal position without disassembly and assembly, and the driving motor of the rope leading-out point is located in a locked state when the movable platform moves, so that the rope leading-out point is not required to be additionally controlled, and extra energy is not consumed.
(3) When the optimal configuration of the rope-traction parallel robot is detected to be incapable of meeting the task, continuous reconfiguration planning is started, configuration reconfiguration is automatically completed when the movable platform moves, the range of the force-feasible working space is dynamically adjusted, and the path of the movable platform is always positioned in the force-feasible working space.
(4) The number of the moving rope leading-out points can be minimized in the continuous reconstruction process, the moving distance of the rope leading-out points can be calculated, the rope leading-out points stop moving after being moved to a proper position, and energy is greatly saved.
Those of ordinary skill in the art will understand that: all or part of the processes of the methods according to the embodiments may be implemented by a program, which may be stored in a computer-readable storage medium, and when executed, may include the processes according to the embodiments of the methods described above. The storage medium may be a magnetic disk, an optical disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), or the like.
The above description is only for the preferred embodiment of the present invention, but the scope of the present invention is not limited thereto, and any changes or substitutions that can be easily conceived by those skilled in the art within the technical scope of the present invention are included in the scope of the present invention. Therefore, the protection scope of the present invention should be subject to the protection scope of the claims. The information disclosed in this background section is only for enhancement of understanding of the general background of the invention and should not be taken as an acknowledgement or any form of suggestion that this information forms the prior art that is already known to a person skilled in the art.

Claims (10)

1. A reconstruction planning method for a rope traction parallel robot is characterized by comprising the following steps:
step 1, setting a coordinate system and parameters of a rope traction parallel robot to be reconstructed and planned, and respectively establishing a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device according to the set coordinate system and parameters;
step 2, establishing a mathematical model corresponding to the feasible working space of the force of the rope-traction parallel robot according to the parameters of the rope-traction parallel robot;
step 3, planning a track of the movable platform and dispersing the track into a set of path points of the movable platform, determining the relation between the force feasible working space of the current configuration of the rope traction parallel robot and the path of the movable platform by combining a mathematical model corresponding to the force feasible working space, judging whether the force feasible working space of the current configuration completely comprises the path of the movable platform according to the mathematical model corresponding to the force feasible working space, if so, determining that the configuration does not need to be adjusted, and finishing the planning; if not, determining to trigger reconstruction, and executing the step 4;
step 4, judging whether the rope traction parallel robot has the optimal configuration, if so, finishing planning; if not, executing the step 5;
and 5, setting an objective function which minimizes the number of the moving rope leading-out points in the continuous reconstruction, solving a rope leading-out point position sequence of the rope traction parallel robot in the continuous reconstruction, and finishing the reconstruction planning of the rope traction parallel robot.
2. The rope-towed parallel robot reconfiguration planning method according to claim 1, wherein in said step 1, the coordinate system and parameters of the rope-towed parallel robot reconfigured are set in the following manner, and the kinetic equation of the moving platform of the rope-towed parallel robot and the kinetic equation of the single rope lead-out device are respectively established according to the set coordinate system and parameters, including:
setting a global coordinate system of a rope-towed parallel robot for a plan to be reconstructed
Figure 179577DEST_PATH_IMAGE001
Origin of (2)
Figure 752510DEST_PATH_IMAGE002
On the ground of the fixed frame of the rope-drawn parallel robot, a rope leading-out point for the rope-drawn parallel robot
Figure 469930DEST_PATH_IMAGE003
For the position vector of
Figure 317669DEST_PATH_IMAGE004
It is shown that,
Figure 69725DEST_PATH_IMAGE005
Figure 157766DEST_PATH_IMAGE006
the number of the leading-out points of the ropes and the number of the ropes are used for the position vector of the movable platform of the rope traction parallel robot
Figure 877329DEST_PATH_IMAGE007
Showing that the ropes pull the ropes of the parallel robots
Figure 217175DEST_PATH_IMAGE008
Has a direction vector of
Figure 75934DEST_PATH_IMAGE009
Establishing a dynamic equation of a movable platform of the rope traction parallel robot and a dynamic equation of a single rope leading-out device;
the dynamic equation of the movable platform is as follows:
Figure 272560DEST_PATH_IMAGE010
(1);
in the formula (1), the reaction mixture is,
Figure 292469DEST_PATH_IMAGE011
a corresponding structural matrix of the parallel robot is drawn for the rope,
Figure 482011DEST_PATH_IMAGE012
Figure 146341DEST_PATH_IMAGE013
a rope tension vector for the rope-towed parallel robot;
Figure 28715DEST_PATH_IMAGE014
the mass of the moving platform for the rope traction parallel robot;
Figure 535920DEST_PATH_IMAGE015
a moving platform acceleration of the rope-towed parallel robot;
Figure 748727DEST_PATH_IMAGE016
Figure 844728DEST_PATH_IMAGE017
is the acceleration of gravity;
the dynamic equation of the single rope leading-out device is as follows:
Figure 320840DEST_PATH_IMAGE018
(2);
in the formula (2), the reaction mixture is,
Figure 505221DEST_PATH_IMAGE019
an axial driving force of a rope pulling-out device for pulling the parallel robot for the rope;
Figure 849614DEST_PATH_IMAGE020
a rope tension for said rope pulling parallel robots;
Figure 550854DEST_PATH_IMAGE021
Figure 712714DEST_PATH_IMAGE022
the weight of a rope take-off device that pulls the parallel robot for the rope;
Figure 866615DEST_PATH_IMAGE017
is the acceleration of gravity;
Figure 936071DEST_PATH_IMAGE023
acceleration of a rope lead-out device of the parallel robot is pulled for the rope.
3. The rope-towed parallel robot reconfiguration planning method according to claim 2, wherein in said step 2, the mathematical model established is:
Figure 554134DEST_PATH_IMAGE025
(3);
in the formula (3), the reaction mixture is,
Figure 699945DEST_PATH_IMAGE026
a corresponding structural matrix of the parallel robot is drawn for the rope,
Figure 528092DEST_PATH_IMAGE012
Figure 151972DEST_PATH_IMAGE027
a rope tension vector for the rope-towed parallel robot;
Figure 890120DEST_PATH_IMAGE028
the rope pulls the dynamic platform of the parallel robot to bear the resultant external force;
Figure 459030DEST_PATH_IMAGE029
the lower limit of the rope tension vector is set to be 10N;
Figure 525206DEST_PATH_IMAGE030
the upper limit of the rope tension vector is set to 200N.
4. The rope-towed parallel robot reconfiguration planning method according to claim 3, wherein in said step 3, a moving platform trajectory is planned and discretized into a moving platform path in the following manner, and a mathematical model corresponding to a force feasible working space is combined to determine a relationship between a force feasible working space of a current configuration of said rope-towed parallel robot and a moving platform path, including:
at the time of
Figure 202044DEST_PATH_IMAGE031
Planning the path of the moving platform by adopting a track planning algorithm to obtain a track
Figure 529120DEST_PATH_IMAGE032
Figure 16733DEST_PATH_IMAGE033
Connecting the track
Figure 819473DEST_PATH_IMAGE034
Figure 785155DEST_PATH_IMAGE035
According to a given time step
Figure 419267DEST_PATH_IMAGE036
Discretization into a set of moving platform waypoints
Figure 874519DEST_PATH_IMAGE037
Figure 977604DEST_PATH_IMAGE038
Figure 948576DEST_PATH_IMAGE031
Is composed of
Figure 453507DEST_PATH_IMAGE039
Integer multiples of;
converting the mathematical model formula (3) corresponding to the force feasible working space into an inequality by adopting a moving hyperplane method:
Figure 79661DEST_PATH_IMAGE040
(4);
in the above formula (4), matrix
Figure 919309DEST_PATH_IMAGE041
Sum vector
Figure 226794DEST_PATH_IMAGE042
Drawing a corresponding structural matrix of the parallel robot according to the rope by a moving hyperplane method
Figure 304340DEST_PATH_IMAGE043
Upper limit of rope tension vector
Figure 242340DEST_PATH_IMAGE030
Lower limit of rope tension vector
Figure 303706DEST_PATH_IMAGE029
Obtaining;
judging whether the force feasible working space of the current configuration of the rope-traction parallel robot completely contains a moving platform path according to the mathematical model corresponding to the force feasible working space in the following way, including:
determining a set of moving platform waypoints
Figure 742778DEST_PATH_IMAGE044
Whether each path point meets the inequality (4) or not is judged, if yes, the feasible working space of the current configuration of the parallel robot drawn by the rope completely contains the path of the movable platform without adjusting the configuration; and if not, determining that the force feasible working space of the current configuration of the rope traction parallel robot cannot completely contain the moving platform path, and triggering reconstruction.
5. The reconfiguration planning method for a rope-drawn parallel robot according to claim 4, wherein in the step 4, determining whether the rope-drawn parallel robot has an optimal configuration comprises:
setting the position of a rope leading-out point of the rope-traction parallel robot
Figure 956721DEST_PATH_IMAGE045
Between the upper and lower limits of position:
Figure 317820DEST_PATH_IMAGE046
(5);
the formula (A) is5) Middle, lower limit of position
Figure 617215DEST_PATH_IMAGE047
(ii) a Upper limit of position
Figure 594398DEST_PATH_IMAGE048
Setting the first objective function as:
Figure 912116DEST_PATH_IMAGE049
(6);
in the above-mentioned formula (6),
Figure 191918DEST_PATH_IMAGE050
capacity margin indexes for moving the power platform away from the boundary of the power feasible working space;
-setting said inequalities (4) and (5) as a first penalty function by means of a penalty function:
Figure 227876DEST_PATH_IMAGE051
(7);
in the formula (7), the reaction mixture is,
Figure 743171DEST_PATH_IMAGE052
is a penalty factor;
Figure 931707DEST_PATH_IMAGE053
is constrained for all inequalities;
Figure 631679DEST_PATH_IMAGE054
the number of inequality constraints;
adding the first penalty function of the formula (7) and the first objective function of the formula (6) to form a new objective function, solving the optimal configuration of the new objective function by adopting a competitive particle swarm algorithm, if the optimal configuration has a solution, determining that the rope traction parallel robot can be adjusted to a fixed optimal configuration, and finishing planning; if the optimization is not solved, it is determined that there is no optimal configuration.
6. Rope-towed parallel robot reconfiguration planning method according to claim 5, characterized in that in said step 4,
Figure 905665DEST_PATH_IMAGE055
is set as
Figure 224651DEST_PATH_IMAGE056
The search space dimension of the competitive particle swarm algorithm is
Figure 519891DEST_PATH_IMAGE057
7. The reconstruction planning method for rope-drawn parallel robot according to claim 5, wherein in the step 5, an objective function for minimizing the number of moving rope leading-out points in the continuous reconstruction is set in the following manner, and the rope leading-out point position sequence of the rope-drawn parallel robot in the continuous reconstruction is solved, including:
step 51, constructing the total displacement of the rope leading-out points into an indefinite linear equation set;
step 52, setting a physical constraint condition of the rope leading-out points and a second objective function which minimizes the number of the moved rope leading-out points in continuous reconstruction;
step 53, solving a speed sequence of rope index out-points in continuous reconstruction through a second objective function which minimizes the number of the moved rope out-points in the continuous reconstruction;
and 54, filtering the solved speed sequence of the rope leading-out points and smoothing to obtain a position sequence of the rope leading-out points.
8. The rope-towed parallel robot reconfiguration planning method according to claim 7, wherein in said step 51, the rope pull-out point total displacement is constructed as an indeterminate linear equation set in the following manner, including:
by using
Figure 407075DEST_PATH_IMAGE058
Representing and moving platform path point set
Figure 965096DEST_PATH_IMAGE059
In (1)
Figure 274723DEST_PATH_IMAGE060
Rope leading-out point corresponding to position of moving platform
Figure 109955DEST_PATH_IMAGE003
The initial position of the cord exit point
Figure 214046DEST_PATH_IMAGE061
The method is obtained by measuring the actually planned rope traction parallel robot;
by using
Figure 524942DEST_PATH_IMAGE062
Figure 123413DEST_PATH_IMAGE063
Indicating a change in the position of the cord exit point; by using
Figure 62419DEST_PATH_IMAGE064
Is shown in time
Figure 353723DEST_PATH_IMAGE065
Inner position
Figure 886336DEST_PATH_IMAGE066
And
Figure 540696DEST_PATH_IMAGE067
the speed of the motor; by using
Figure 84941DEST_PATH_IMAGE068
Figure 796414DEST_PATH_IMAGE005
Representing and moving platform path point set
Figure 816322DEST_PATH_IMAGE069
Corresponding rope leading-out point
Figure 756596DEST_PATH_IMAGE003
The speed sequence of (a);
the rope leading-out point of the rope traction parallel robot is in the total time
Figure 670195DEST_PATH_IMAGE031
Total displacement of internal movement
Figure 631197DEST_PATH_IMAGE070
Comprises the following steps:
Figure 810506DEST_PATH_IMAGE071
(8);
in the formula (8), the reaction mixture is,
Figure 741422DEST_PATH_IMAGE072
is one
Figure 588155DEST_PATH_IMAGE073
Vector of (3), solution in equation (8)
Figure 188901DEST_PATH_IMAGE074
Is not unique;
Figure 361563DEST_PATH_IMAGE075
is one
Figure 581323DEST_PATH_IMAGE076
A constant vector of (2);
in step 52, the setting of the physical constraint conditions for the rope exit points and the second objective function for minimizing the number of the moved rope exit points in the continuous reconstruction includes:
setting a rope leading-out point
Figure 531830DEST_PATH_IMAGE077
Position of
Figure 303477DEST_PATH_IMAGE078
Speed, velocity
Figure 722957DEST_PATH_IMAGE079
Acceleration of the object
Figure 995676DEST_PATH_IMAGE080
Satisfy respective upper and lower limits:
Figure 551422DEST_PATH_IMAGE081
(9);
in the formula (9), the reaction mixture is,
Figure 759549DEST_PATH_IMAGE082
Figure 650014DEST_PATH_IMAGE083
Figure 477155DEST_PATH_IMAGE084
Figure 215304DEST_PATH_IMAGE085
(ii) a Setting a second objective function for minimizing the number of rope exit points moved in the continuous reconstruction as:
Figure 518634DEST_PATH_IMAGE086
(10);
in the formula (10), the reaction mixture is,
Figure 584810DEST_PATH_IMAGE087
the value range is 0 to 1 for weight;
Figure 261648DEST_PATH_IMAGE088
the number of the rope leading-out points is the number of the rope leading-out points;
Figure 854304DEST_PATH_IMAGE089
is a speed sequence of rope leading-out points;
Figure 341917DEST_PATH_IMAGE090
the number of the path points of the movable platform is;
Figure 144656DEST_PATH_IMAGE091
capacity margin indexes for moving the power platform away from the boundary of the power feasible working space;
in the step 53, solving a speed sequence of rope index exit points in continuous reconstruction by using a second objective function that minimizes the number of moving rope exit points in continuous reconstruction includes:
-setting the inequality of said equation (4) and said equation (9) as a second penalty function by means of a penalty function, adding the second penalty function to a second objective function of said equation (10) as an overall objective function, the corresponding sequence of rope exit point positions being represented during the optimization iteration as:
Figure 110338DEST_PATH_IMAGE092
(11);
in the above-mentioned formula (11),
Figure 557500DEST_PATH_IMAGE093
solving the ropes in the continuous reconstruction process by adopting a competitive particle swarm algorithm for the initial known position of each rope leading-out pointIndexing a velocity sequence of points;
in the step 54, the solved speed sequence of the rope leading-out points is filtered and smoothed to obtain a position sequence of the rope leading-out points, which includes:
setting a speed sequence for the exit point of a rope
Figure 465282DEST_PATH_IMAGE094
The filtration condition of each element in (1) is completely 0:
Figure 771630DEST_PATH_IMAGE095
(12);
in the above-mentioned formula (12),
Figure 603320DEST_PATH_IMAGE096
to obtain
Figure 829289DEST_PATH_IMAGE094
Then obtaining the position sequence of the rope leading-out points through the formula (11); and smoothing by adopting a spline curve to obtain a position sequence of the rope leading-out points.
9. The rope-towed parallel robot reconfiguration planning method according to claim 8,
in the step 52, the process is carried out,
Figure 861967DEST_PATH_IMAGE097
set to 0.995;
in said step 53, in a second penalty function
Figure 701616DEST_PATH_IMAGE055
Is set as
Figure 71418DEST_PATH_IMAGE056
In the step 53, the search space dimension of the competitive particle swarm optimization is
Figure 430855DEST_PATH_IMAGE098
10. Rope-towed parallel robot reconfiguration planning method according to any one of claims 1 to 8, characterized in that in said method, said reconfigured planned rope-towed parallel robot comprises:
a fixed frame,
Figure 618122DEST_PATH_IMAGE057
A rope leading-out device,
Figure 430221DEST_PATH_IMAGE057
A vertical screw rod,
Figure 869292DEST_PATH_IMAGE099
A motor,
Figure 332503DEST_PATH_IMAGE057
A winding drum,
Figure 441405DEST_PATH_IMAGE057
A rope and a movable platform, wherein the rope is arranged on the movable platform,
Figure 992997DEST_PATH_IMAGE057
is a positive integer; wherein,
each rope leading-out device consists of a sliding block and a guide pulley, and the guide pulley is connected and arranged on the sliding block and can synchronously move along with the sliding block;
Figure 704601DEST_PATH_IMAGE057
the vertical lead screws are arranged in the fixed frame in a surrounding manner, a sliding block of a rope leading-out device is arranged on each vertical lead screw, one end of each vertical lead screw is connected with a motor, and the vertical lead screws can rotate under the driving of the motors and drive the sliding blocks to move up and down;
Figure 38630DEST_PATH_IMAGE057
The winding drums are arranged on the ground in the fixed frame in a surrounding manner, one winding drum is arranged below each vertical lead screw, a rope is wound on each winding drum, each winding drum is connected with a motor, and the winding drums can rotate under the driving of the motors to wind and unwind the connected rope;
the other end of each rope is connected with the movable platform after sequentially passing around a guide pulley of a rope leading-out device above the rope, and each rope suspends the movable platform in the fixed frame.
CN202210280216.2A 2022-03-22 2022-03-22 Reconstruction planning method for rope traction parallel robot Active CN114367964B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210280216.2A CN114367964B (en) 2022-03-22 2022-03-22 Reconstruction planning method for rope traction parallel robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210280216.2A CN114367964B (en) 2022-03-22 2022-03-22 Reconstruction planning method for rope traction parallel robot

Publications (2)

Publication Number Publication Date
CN114367964A CN114367964A (en) 2022-04-19
CN114367964B true CN114367964B (en) 2022-07-15

Family

ID=81146111

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210280216.2A Active CN114367964B (en) 2022-03-22 2022-03-22 Reconstruction planning method for rope traction parallel robot

Country Status (1)

Country Link
CN (1) CN114367964B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114706312B (en) * 2022-06-06 2022-09-30 中国科学技术大学 High-precision self-adaptive cooperative control method for rope traction parallel robot
CN115805594B (en) * 2023-02-06 2023-06-16 中国科学技术大学 Composite optimization method for track and configuration of reconfigurable rope-driven lower limb rehabilitation robot
CN116595869B (en) * 2023-05-11 2023-11-24 哈尔滨工业大学(深圳) Data driving control strategy for collision-allowed rope traction parallel robot
CN116922398B (en) * 2023-09-15 2023-12-22 华侨大学 Rope robot and path planning method and device thereof

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104647367B (en) * 2014-12-29 2016-05-25 合肥工业大学 The robot palletizer in parallel of the compound driving of a kind of rope bar
CN107627299B (en) * 2017-09-12 2019-10-25 中国科学技术大学 A kind of kinematic parameter errors scaling method of rope driving parallel robot
CN111319028B (en) * 2020-03-18 2022-04-19 中国科学技术大学 Rope traction parallel robot with variable structure and kinematics multi-solution solving method thereof
CN111360793B (en) * 2020-03-31 2022-07-05 合肥工业大学 Flexible cable driven series-parallel spraying robot mechanism and operation method thereof
CN111938989B (en) * 2020-07-20 2022-05-17 哈尔滨工程大学 Motion stability evaluation method of rigid-flexible hybrid lower limb gait rehabilitation training robot
CN113305809B (en) * 2021-05-27 2022-04-05 哈尔滨工业大学 Force sense simulation control method of fully-constrained space rope driving parallel mechanism

Also Published As

Publication number Publication date
CN114367964A (en) 2022-04-19

Similar Documents

Publication Publication Date Title
CN114367964B (en) Reconstruction planning method for rope traction parallel robot
CN114347005B (en) Rope traction parallel robot continuous reconstruction planning method capable of avoiding obstacles
EP2636632B1 (en) Crane controls with drive restriction
CN110717218B (en) Electric drive vehicle distributed power drive system reconstruction control method and vehicle
Alpeggiani et al. Surface plasmons and strong light-matter coupling in metallic nanoshells
CN102602547B (en) Wheeled lunar vehicle driving control method based on slip ratio adjustment
CN114706312B (en) High-precision self-adaptive cooperative control method for rope traction parallel robot
Lee et al. Transition from the adiabatic to the sudden limit in core-level photoemission: a model study of a localized system
CN114643584A (en) Rapid terminal sliding mode synchronous control method for rope traction parallel robot
CN106216284A (en) The most clear a kind of plate system
US20240253604A1 (en) Path tracking control method and device for intelligent electric vehicles
CN212101478U (en) Cable take-up device for tunnel detection
CN110758760A (en) Device capable of being used for taking off and landing of unmanned aerial vehicle and unmanned aerial vehicle undercarriage
CN115070771B (en) Elastic double-ring synchronous control method for rope traction parallel robot
CN206872315U (en) Jib structure and crane
CN213734490U (en) Land-air dual-purpose multi-mode ducted aircraft
CN211442810U (en) Device capable of being used for taking off and landing of unmanned aerial vehicle and unmanned aerial vehicle undercarriage
Hossain et al. Tractive performance prediction of intelligent air-cushion track vehicle: fuzzy logic approach
CN206987490U (en) A kind of bridge-type avoidance needless type stereoscopic garage
CN110817612A (en) Cable take-up and pay-off container and transport vehicle provided with same
CN118331046A (en) Development machine mining and transportation cooperative control method, device, storage medium and program product
CN220351400U (en) Wire rope coils exhibition and puts device
CN2862453Y (en) Cable drawing machine
CN221251502U (en) Bouncing type robot trolley
CN108423087B (en) A kind of trailer robot

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