[go: up one dir, main page]

CN108393884B - Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system - Google Patents

Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system Download PDF

Info

Publication number
CN108393884B
CN108393884B CN201810047259.XA CN201810047259A CN108393884B CN 108393884 B CN108393884 B CN 108393884B CN 201810047259 A CN201810047259 A CN 201810047259A CN 108393884 B CN108393884 B CN 108393884B
Authority
CN
China
Prior art keywords
task
teleoperation
planning
manipulator
divided
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
CN201810047259.XA
Other languages
Chinese (zh)
Other versions
CN108393884A (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201810047259.XA priority Critical patent/CN108393884B/en
Publication of CN108393884A publication Critical patent/CN108393884A/en
Application granted granted Critical
Publication of CN108393884B publication Critical patent/CN108393884B/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/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1682Dual arm manipulator; Coordination of several manipulators

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及一种基于Petri网的多机械臂遥操作系统协同任务规划方法,采用基于Petri网的方法,对多机械臂遥操作系统进行协同任务规划,通过对整个遥操作任务系统进行分层和分模块,依据Petri网理论建立模型,生成控制指令动作。该方法用于多臂机器人遥操作系统的在轨维修、航天器燃料加注和载荷照料等在轨服务任务,以及核电站内部、深海等人类无法触及场所的操控任务。有益效果:1、帮助非专业人员进行多机械臂遥操作系统的协同任务规划。2、提高操作效率、精度和操控安全性。3、根据Petri网生成的操控指令可便捷地进行操控。

Figure 201810047259

The invention relates to a collaborative task planning method for a multi-manipulator teleoperation system based on a Petri net. The Petri net-based method is used to carry out collaborative task planning for a multi-manipulator teleoperation system. It is divided into modules, and the model is established according to the Petri net theory, and the control command action is generated. This method is used for on-orbit service tasks such as the on-orbit maintenance of the multi-armed robot teleoperating system, spacecraft fueling and load care, as well as the manipulation tasks in the interior of nuclear power plants, deep seas and other places that humans cannot reach. Beneficial effects: 1. Helping non-professionals to carry out collaborative task planning of multi-manipulator teleoperating systems. 2. Improve operational efficiency, precision and control safety. 3. It can be easily controlled according to the control instructions generated by the Petri net.

Figure 201810047259

Description

Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system
Technical Field
The invention belongs to the field of teleoperation of robots, and relates to a Petri network-based collaborative task planning method for a multi-mechanical-arm teleoperation system.
Background
Aiming at in-orbit service tasks of multi-arm robot teleoperation systems, such as in-orbit maintenance, spacecraft fuel filling, load care and the like, and control tasks of human inaccessible places inside nuclear power stations, deep sea and the like, a plurality of problems are faced. Because the single mechanical arm can only complete simple operations such as screwing, transferring, monitoring and the like, complex and large-scale tasks are difficult to complete, at the moment, multiple mechanical arms are required to operate, and the multiple mechanical arms can work independently or cooperatively. The master-slave and cooperative control problems of the multi-mechanical arm teleoperation system are the main problems facing cooperative task planning. The multi-mechanical arm teleoperation system collaborative task planning technology generally divides an overall task into a plurality of subtasks to be carried out, and then divides the multi-mechanical arm according to the requirements of the subtasks, so as to meet the overall task requirements. Therefore, the Petri network-based multi-mechanical arm teleoperation system collaborative task planning method has important significance for teleoperation task planning.
The previous research work shows that the existing task planning of a single mechanical arm mostly adopts a Cartesian space planning technology and a joint space planning technology, the Cartesian space planning is to use a time function to represent the speed, the acceleration and the pose value of the mechanical arm, and the joint speed, the acceleration and the joint displacement of the mechanical arm are obtained through inverse solution. The joint space planning calculation amount is small, the efficiency is high, the rapid transfer stage is suitable for the stage that the mechanical arm end effector needs to be rapidly transferred when leaving a target, but the motion of each joint and the motion of the end effector have the complex problems of coupling and the like, and the joint space planning calculation amount is not in one-to-one correspondence.
Disclosure of Invention
Technical problem to be solved
In order to avoid the defects of the prior art, the invention provides a Petri network-based collaborative task planning method for a multi-mechanical-arm teleoperation system.
Technical scheme
A Petri network-based collaborative task planning method for a multi-mechanical-arm teleoperation system is characterized by comprising the following steps:
step 1: describing an operation task of the multi-mechanical-arm teleoperation system collaborative task planning by adopting a Petri network six-element group expression, wherein the six-element group expression comprises a control object set, a teleoperation task target set, a terminal environment and operation constraint set, a system variable weight function and a system variable state set;
the method comprises the steps of performing task layering on a multi-mechanical-arm teleoperation system into a task layer, an action layer and an instruction layer;
dividing a control object set and a teleoperation task target set into task layers, dividing a terminal environment and operation constraint set into action layers, and dividing a system variable set, a system variable weight function and a system variable state set into instruction layers;
the task layer comprises: a task planning main process, a data analysis sub-process, a task scheduling sub-process, a task allocation sub-process and a track planning sub-process; the action layer comprises capturing, transferring, placing and withdrawing actions; the instruction layer includes task commands, action commands, and execution commands. The task hierarchy also contains corresponding task modules: task planning module, data analysis module, task scheduling module, task allocation module and trajectory planning module
Step 2: according to different mechanical arms, control tasks and process stages, a single-operator independent operation single-mechanical-arm working mode, a multi-operator independent operation multi-mechanical-arm working mode and a multi-operator cooperative operation multi-mechanical-arm working mode are divided into:
when the operation task is moved from one point to another point, directly controlling an operation target in an instruction mode, and adopting a single-operator independent operation single-mechanical-arm working mode;
when operation task areas among the mechanical arms are not overlapped, the mechanical arms are operated relatively independently, and the number of constraints caused by collision, load and relative positions generated by operation interval division is less than 10, a multi-operator independent operation multi-mechanical-arm working mode is adopted, a control method is the same as that of a plurality of single-operator operation single mechanical arms, namely, a control instruction is sent to the corresponding mechanical arms independently;
when operation task areas among the mechanical arms are overlapped and the operating environment and the constraint number of the operation tasks are more than 10, adopting a multi-operator cooperative operation multi-mechanical arm working mode;
step 3, dividing the multi-mechanical arm teleoperation system into teleoperation task stages in cooperation with the teleoperation task stages:
generating a teleoperation subtask sequence according to a task planning process and a task planning module in a task layer, and dividing the teleoperation subtask sequence into four types of operations including capturing operation, transferring operation, placing operation and withdrawing operation according to the execution time sequence of the teleoperation task;
the capture operation is divided into two parts of tracking a target object and approaching the captured target object, and the tracking target object selects a corresponding task point and path mode according to the environmental information; selecting a corresponding path close to the grabbing target object according to the coordinate data instruction;
the transfer operation is used for the conveying function of task operation, and a task point and a path planning mode of the transfer operation are selected according to the terminal environment and the operation constraint set in the six-tuple group to realize a transfer operation task;
the placing operation is a link required by the mechanical arm to execute a task or carry a target object by using a tool each time, and is divided into two parts of approaching and releasing the target and evacuating the safe distance, and a task point and a path planning mode of the placing operation are selected according to a system variable set, a system variable weight function and a system variable state set in a six-tuple group and environmental information to realize the placing operation task;
the withdrawing operation is used for an operation task that the mechanical arm needs to return to an initial working state after executing a certain task, and preparation is made for the execution of the subsequent task according to the control object set and the teleoperation task target set in the six-tuple;
and 4, step 4: and (3) according to the mathematical description in the step (1), the selection of the working mode in the step (2) and the classification of the operation modes in the step (3), establishing a Petri network model for the cooperative tasks of the multi-mechanical-arm teleoperation system by adopting a Petri network, performing task simulation on the established Petri network model, generating a corresponding action instruction, and generating a cooperative task planning step.
Advantageous effects
The invention provides a Petri network-based collaborative task planning method for a multi-mechanical arm teleoperation system. The method is used for on-orbit service tasks of multi-arm robot teleoperation systems, such as on-orbit maintenance, spacecraft fuel filling, load care and the like, and control tasks of human inaccessible places inside nuclear power stations, deep sea and the like. Referring to the previous literature data, the method is a cooperative task planning method and can be applied to cooperative task planning of a multi-mechanical arm teleoperation system.
Compared with the prior art, the invention has the following beneficial effects: 1. the system helps non-professionals to carry out collaborative task planning of the multi-mechanical arm teleoperation system. 2. The operation efficiency, the precision and the control safety are improved. 3. The control instruction generated according to the Petri network can be conveniently controlled.
Drawings
FIG. 1 is a schematic diagram of a hierarchy of mission planning
FIG. 2 is a schematic diagram of task pattern division
FIG. 3 is a task command level diagram
FIG. 4 is a coordination task execution diagram of a Petri network-based multi-mechanical arm teleoperation system
FIG. 5 is a Petri network model diagram
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
the invention provides a method for collaborative task planning of a multi-mechanical arm teleoperation system based on a Petri network model aiming at collaborative task planning requirements of the multi-mechanical arm teleoperation system, which comprises the following steps:
and according to the task requirements, the task plan is layered and divided into modules.
The method comprises the following steps: describing an operation task of the multi-mechanical-arm teleoperation system collaborative task planning by adopting a Petri network six-element group expression, wherein the six-element group expression comprises a control object set, a teleoperation task target set, a terminal environment and operation constraint set, a system variable weight function and a system variable state set, and the expression is used for describing the relationship among system parameters, instruction triggering, a terminal environment and a task target.
And according to the six subsets in the six-element expression and the task requirement of the whole system, carrying out task layering on the multi-mechanical-arm teleoperation system, wherein the task layering is divided into a task layer, an action layer and an instruction layer, the task layer is divided according to the control object set and the teleoperation task target set in the six-element group, the action layer is divided according to the terminal environment and the operation constraint set, and the instruction layer is divided according to the system variable set, the system variable weight function and the system variable state set.
Wherein, the task layer includes: a task planning main process, a data analysis sub-process, a task scheduling sub-process, a task allocation sub-process and a track planning sub-process; the action layer comprises capturing, transferring, placing and withdrawing actions; the instruction layer includes task commands, action commands, and execution commands. The task hierarchy also contains corresponding task modules: the system comprises a task planning module, a data analysis module, a task scheduling module, a task allocation module and a trajectory planning module.
Step two: in task division, in order to realize different operation accuracy and control stability, a single-operator independent operation single-mechanical-arm working mode, a multi-operator independent operation multi-mechanical-arm working mode and a multi-operator cooperative operation multi-mechanical-arm working mode are required to be divided according to different mechanical arms, control tasks and process stages.
When the operation task is simple and single and only moves from one point to another point, the operation target only needs to be directly controlled in an instruction mode, and a single-operator independent operation single-mechanical-arm working mode is adopted; when operation task areas among the mechanical arms are not overlapped, the mechanical arms are operated relatively independently, and the constraints caused by collision, load and relative positions generated by operation interval division are relatively less, a multi-operator independent operation multi-mechanical-arm working mode is adopted, a control method is the same as that of a plurality of single-operator operation single mechanical arms, namely, a control instruction is sent to the corresponding mechanical arms independently; when the operation task areas of the mechanical arms are overlapped, the operation environment, the operation task constraints are more, and the operation risk is high, a multi-operator cooperative operation multi-mechanical-arm working mode is adopted.
Step three: and (3) dividing the teleoperation task stage by the multi-mechanical arm teleoperation system in cooperation with teleoperation.
According to the task planning process and the task planning module in the task layer, a teleoperation subtask sequence is generated, and according to the execution time sequence of the teleoperation tasks, the teleoperation subtask sequence can be divided into four types of operation.
The four types of operations are a capture operation, a transfer operation, a put operation, and a retract operation.
The method comprises the following steps that a capturing operation is divided into two parts, namely a tracking target object and a target object which is close to be captured, and the tracking target object selects a corresponding task point and path mode according to environmental information; and selecting a corresponding path close to the grabbing target object according to the coordinate data instruction.
The transfer operation is used for the conveying function of the task operation, and the task point and the path planning mode of the transfer operation are selected according to the terminal environment and the operation constraint set in the six-tuple group to realize the transfer operation task.
The placing operation is a link required by the mechanical arm to execute a task or carry a target object by using a tool each time, and is divided into two parts of approaching and releasing the target and evacuating the safe distance, and a task point and a path planning mode of the placing operation are selected according to a system variable set, a system variable weight function and a system variable state set in a six-tuple group and environmental information, so that the placing operation task is realized.
And the withdrawing operation is used for the operation task that the mechanical arm needs to return to the initial working state after executing a certain task, and the preparation is made for the execution of the subsequent task according to the control object set and the teleoperation task target set in the six-tuple.
Step four: and establishing a Petri network model for the cooperative task teleoperation of the multi-mechanical-arm teleoperation system by adopting a Petri network, and performing task simulation on the established Petri network model to generate a corresponding action instruction to prepare for subsequent operation and control.
The teleoperation task planning system mainly aims to combine different teleoperation tasks and teleoperation modes, analyze, decompose and decide the teleoperation tasks, realize task planning under various teleoperation modes and generate a mechanical arm system motion data sequence or a task sequence. It should have the following important functions:
1) the system has the capacity of planning top-level tasks, and meets the teleoperation requirements of non-professionals;
2) completing the path planning of Cartesian space and joint space of the multiple mechanical arms in multiple working modes;
3) the verification and the inspection of the task planning are completed, and the planned path meets the safety requirement;
4) the use mode of the mechanical arm can be given quickly according to task conditions;
5) the time and energy consumption required by the movement of the mechanical arm are comprehensively considered in the task planning process, the safety and the reliability are high, and the whole is optimal.
The specific embodiment is as follows:
the method comprises the following steps: describing the expression structure of the hexahydric group of the Petri network:
the Petri net is a net-shaped information energy flow model and comprises three elements: depot, transition, and arc. Wherein the library represents a state of the system; the transition represents events or changes of behaviors and states occurring in the system, and the occurrence of the transition is controlled by the library; arcs represent the relationship between local states and transitions. Yet another important component in the Petri Net model is the Token, which is contained in the depository. With the progress of the task, after a certain transition is excited, some preconditions are not satisfied any more, and another posterior condition is satisfied, at the moment, the Token can flow to different libraries according to the direction of the arc, so that the change of the system state is described dynamically. The characteristic of a token is in which library it is true, otherwise it is false.
The Petri net six-tuple is expressed as: n ═ P, T, F, K, W, M), where
1) N denotes a set of arms, (P, T, F) is a directed set,
Figure BDA0001551283330000071
representing a set of libraries, representing a set of transitions, F representing an arc, is
Figure BDA0001551283330000072
A subset of (a) representing a relationship between a library and a transition;
2) k represents the capacity contained in the library and is the mapping from the library to the natural number set N;
3) w represents the weight of the corresponding arc, which is a weight function of F;
4) m denotes a network identification vector.
According to the above, taking the multi-arm teleoperation system cooperative task plan as an example, the six-element group structure of the task is described as N ═ (P, T, F, K, W, M), wherein
1) P represents a plurality of robots;
2) t represents a spatial cooperative/non-cooperative target set;
3) f represents that the multiple mechanical arms and the space cooperative/non-cooperative target are in the same Cartesian coordinate;
4) k represents the position and the posture of a space cooperative/non-cooperative target and the position and the posture of a multi-mechanical arm;
5) w represents the position and attitude of the spatial cooperative/non-cooperative target and the position and attitude of the arrested object;
6) m represents the current set of system states returned by the sensor.
Step two: dividing a multi-mechanical arm teleoperation system in cooperation with teleoperation task modes:
in task division, as can be seen from fig. 1, different operation accuracies and operation stabilities need to be achieved according to different mechanical arms, operation tasks and process stages, and the task division is divided into a single-operator independent operation single-mechanical-arm working mode, a multi-operator independent operation multi-mechanical-arm working mode and a multi-operator cooperative operation multi-mechanical-arm working mode
1) Single-operator independent operation single mechanical arm working mode
The control method of the single operator in the single mechanical arm working mode is the same as the method of the single operator in the single mechanical arm working mode, and the operation target is directly controlled in an instruction mode.
2) Multi-manipulator independent operation multi-manipulator working mode
Under the working mode that multiple operators independently operate multiple mechanical arms, the control method is the same as that of a plurality of single operators operating a single mechanical arm, and is mainly used for the condition that operation task areas among the mechanical arms are not overlapped.
3) Multi-manipulator cooperative operation multi-manipulator working mode
The multi-manipulator cooperative operation multi-manipulator working mode is mainly used for the conditions that operation task areas among all the manipulators are overlapped, the operation environment and operation tasks are more in intensive and operation risks are high.
Further, on the basis of selecting the working mode, according to different task scheduling stages and characteristics, the control modes of the mechanical arm need to be divided into the following three types:
1) position control: the robotic arm is employed in free motion in space.
2) Impedance control: when the contact operation is performed through the mechanical arm, joint torque is applied to the mechanical arm to realize impedance control.
3) Zero force control: when the mechanical arm paw is used for capturing/releasing load, the joint moment is zero.
Step three: the multi-mechanical arm teleoperation system is cooperated with teleoperation task stage division:
the task decomposition module decomposes and analyzes the teleoperation task according to a teleoperation task instruction given by an operator, firstly generates a teleoperation subtask sequence, and can divide the teleoperation subtask sequence into the following four categories according to the execution time sequence of a common teleoperation task:
1) capture operations
The most common function of a robotic arm as a humanoid hand system is to capture and manipulate a target object. Therefore, the capturing operation is the first step of the task operation of the mechanical arm, and whether the capturing operation is successful or not directly influences the subsequent task operation of the mechanical arm. The capture operation is analyzed, and the capture operation is divided into two parts of tracking a target object and approaching to a capture target object. And selecting a corresponding task point and path mode according to the environment information by the tracking target object. And selecting a corresponding path close to the grabbing target object according to the coordinate data instruction.
2) Transfer operation
And the transfer operation completes the conveying function of the task operation, and selects a task point and a path planning mode of the transfer operation according to the terminal environment and the operation constraint set in the six-tuple group to realize the transfer operation task.
3) Placing operation
The placing operation is a link required by the mechanical arm to execute a task or carry a target object by using a tool each time, and is divided into two parts of approaching and releasing the target and evacuating the safe distance, and a task point and a path planning mode of the placing operation are selected according to a system variable set, a system variable weight function and a system variable state set in a six-tuple group and environmental information, so that the placing operation task is realized.
4) Withdrawing operation
And the withdrawing operation is used for the operation task that the mechanical arm needs to return to the initial working state after executing a certain task, and the preparation is made for the execution of the subsequent task according to the control object set and the teleoperation task target set in the six-tuple.
Further, as shown in fig. 4, the task decomposition module further generates a task command according to the requirements of different types of subtasks, and in this process, the task scheduling module is required to give out operation constraints of different task phases. The task commands have three levels: task level commands, action level commands, and execute level commands. Wherein, the task-level command can be decomposed into a plurality of action-level commands, and each action-level command can be implemented by a plurality of groups of execution-level commands, the level relationship of which is shown in fig. 3.
Step four: modeling and simulating a Petri network:
taking a two-mechanical-arm teleoperation task as an example, describing a process of realizing two-arm task allocation through a petri network when two persons operate two-mechanical-arm cooperative motion, since the mechanical arms are required to execute tasks independently or sequentially or cooperatively in the operation process, the motion states of the two mechanical arms are divided into four states, as shown in table 1, the states are respectively the states of activating and preparing a library, and switching is required between the four states when performing operation (grabbing or transferring).
TABLE 1 two-arm Petri net depot list
Figure BDA0001551283330000101
First, the task of the two-arm robot is that the arm 1 approaches a capture target, holds the target after capture, and the arm 2 approaches the target, and performs an action according to an instruction.
Next, table 2 shows event information of transitions 1, 2, 3, 4, 5, 6, and 7 in fig. 5. When the arms are in the ready state, arm 1 or arm 2 can perform the task, respectively, by activating transitions 5 or 6. Again, the excitation transition 7 represents simultaneous and parallel execution of tasks by both arms, as a result of the separation into individual and coordinated motions.
TABLE 2 significance table of transition and two-arm Petri nets
Figure BDA0001551283330000102
Finally, in the operation process of the two arms, the task executed by the two arms includes three stages, each stage has different functions, motion ranges and task types, the task execution sequence is shown in table 2, in the operation process, the mechanical arm needs to pass through the three task stages, the first two task stages are respectively independent operation, and the last task stage is cooperative operation. In the stage of single task operation, an operator sequentially operates one mechanical arm to complete the grabbing of the target, in the stage, the working space of the mechanical arm has no mutually overlapped part, and the grabbing track approaching the target is realized by respectively planning the operation tracks. In the second phase, namely the cooperative capturing phase, the two arms need to be operated cooperatively, and in the operation process, the two mechanical arms and the target may collide, which requires that the overlapping of task sections of the two mechanical arms is considered in task allocation, namely when the two mechanical arms approach each other, collision may occur due to trajectory deviation, and an emergency treatment scheme under the collision condition needs to be designed while designing the reference trajectory.
TABLE 2 double arm executive task table
Figure BDA0001551283330000111

Claims (1)

1.一种基于Petri网的多机械臂遥操作系统协同任务规划方法,其特征在于步骤如下:1. a multi-manipulator teleoperating system collaborative task planning method based on Petri net, is characterized in that step is as follows: 步骤1:采用Petri网六元组表达式对多机械臂遥操作系统协同任务规划的操作任务进行描述,所述六元组表达式包括操控对象集、遥操作任务目标集、终端环境及操作约束集、系统变量集、系统变量权重函数和系统变量状态集;Step 1: Use the Petri net six-tuple expression to describe the operation task of the multi-manipulator teleoperation system collaborative task planning, and the six-tuple expression includes the control object set, the teleoperation task target set, the terminal environment and the operation constraints set, system variable set, system variable weight function and system variable state set; 对多机械臂遥操作系统进行任务分层为任务层、动作层和指令层;The task layering of the multi-manipulator teleoperating system is divided into task layer, action layer and instruction layer; 操控对象集和遥操作任务目标集划分任务层,终端环境及操作约束集划分动作层,系统变量集、系统变量权重函数和系统变量状态集划分指令层;The manipulation object set and the teleoperation task target set are divided into the task layer, the terminal environment and operation constraint set are divided into the action layer, and the system variable set, the system variable weight function and the system variable state set are divided into the instruction layer; 所述任务层包括:任务规划主进程、数据分析子进程、任务调度子进程、任务分配子进程、轨迹规划子进程;动作层包括捕获、转移、放置和回撤动作;指令层包括任务命令、动作命令和执行命令;任务层还包含相应的任务模块:任务规划模块、数据分析模块、任务调度模块、任务分配模块和轨迹规划模块The task layer includes: a task planning main process, a data analysis sub-process, a task scheduling sub-process, a task allocation sub-process, and a trajectory planning sub-process; the action layer includes capture, transfer, placement and retraction actions; the instruction layer includes task commands, Action commands and execution commands; the task layer also includes corresponding task modules: task planning module, data analysis module, task scheduling module, task allocation module and trajectory planning module 步骤2:根据不同的机械臂、操控任务和进程阶段,划分为单操作者独立操作单机械臂工作模式、多操作者独立操作多机械臂工作模式和多操作者协同操作多机械臂工作模式:Step 2: According to different manipulators, manipulation tasks and process stages, it is divided into single-operator independent operation of single manipulator working mode, multi-operator independent operation of multiple manipulators working mode and multi-operator cooperative operation of multiple manipulators working mode: 当操作任务为由一个点移动到另一个点时,按照指令式的方式直接对操作目标进行操控,采用单操作者独立操作单机械臂工作模式;When the operation task is to move from one point to another point, the operation target is directly controlled according to the command method, and the single operator independently operates the single manipulator working mode; 当各机械臂之间操作任务区域没有重叠,且各机械臂操作相对独立,操作区间划分产生的碰撞、负载和相对位置带来的约束数目小于10时,采用多操作者独立操作多机械臂工作模式,控制方法和多个单操作者操作单机械臂是相同的,即单独发送控制指令给相应的机械臂;When the operation task areas between the manipulators do not overlap, and the operations of the manipulators are relatively independent, and the number of constraints caused by collisions, loads and relative positions caused by the division of the operating area is less than 10, the multi-operator is used to independently operate the multi-manipulators to work. The mode and control method are the same as those of multiple single operators operating a single manipulator, that is, sending control commands to the corresponding manipulators individually; 当各机械臂之间操作任务区域有重叠,且操作环境、操控任务集约束数目大于10时,采用多操作者协同操作多机械臂工作模式;When the operation task areas between the manipulators overlap, and the number of constraints on the operating environment and the control task set is greater than 10, the multi-operator collaborative operation mode of the multi-manipulator is adopted; 步骤3、多机械臂遥操作系统协同遥操作任务阶段划分:Step 3. Multi-manipulator teleoperation system collaborative teleoperation task stage division: 根据任务层中的任务规划进程和任务规划模块,生成遥操作子任务序列,根据遥操作任务的执行时间顺序,将遥操作子任务序列分为捕获操作、转移操作、放置操作和回撤操作四类操作;According to the task planning process and task planning module in the task layer, the teleoperation sub-task sequence is generated, and according to the execution time sequence of the teleoperation tasks, the teleoperation sub-task sequence is divided into four parts: capture operation, transfer operation, placement operation and retraction operation. class operation; 所述捕获操作分为跟踪目标物和靠近抓取目标物两部分,跟踪目标物根据环境信息选择相应的任务点和路径方式;靠近抓取目标物根据坐标数据指令选择相应路径;The capturing operation is divided into two parts: tracking the target object and approaching the grabbing target object. The tracking target object selects the corresponding task point and path mode according to the environmental information; the approaching and grabbing target object selects the corresponding path according to the coordinate data instruction; 所述转移操作用于任务操作的运送功能,根据六元组中的终端环境及操作约束集,选取转移操作的任务点和路径规划方式,实现转移操作任务;The transfer operation is used for the transport function of the task operation, and according to the terminal environment and the operation constraint set in the six-tuple, the task point and the path planning method of the transfer operation are selected to realize the transfer operation task; 所述放置操作是机械臂每次利用工具执行任务或者搬运目标物所需的环节,分为靠近并释放目标与撤离安全距离两部分,根据六元组中的系统变量集、系统变量权重函数和系统变量状态集,以及环境信息,选取放置操作的任务点和路径规划方式,实现放置操作任务;The placement operation is a link required by the robotic arm to perform a task or carry a target each time using a tool. It is divided into two parts: approaching and releasing the target and evacuating the safety distance. According to the system variable set in the six-tuple, the system variable weight function and System variable state set, as well as environmental information, select the task point and path planning method of the placement operation, and realize the placement operation task; 所述回撤操作用于机械臂在执行完某项任务后,需要回到其初始工作状态的操作任务,根据六元组中的操控对象集和遥操作任务目标集,为其后续任务执行做准备;The retraction operation is used for the operation task that the robotic arm needs to return to its initial working state after performing a certain task. According to the control object set and the teleoperation task target set in the six-tuple, the following tasks are performed. Prepare; 步骤4:依据步骤1的数学描述,步骤2的工作模式的选择,步骤3操作方式的分类,采用Petri网对多机械臂遥操作系统协同任务建立Petri网模型,并对建立的Petri网模型进行任务仿真,生成相应的动作指令,生成协同任务规划步骤。Step 4: According to the mathematical description of step 1, the selection of the working mode in step 2, the classification of the operation mode in step 3, the Petri net model is used to establish a Petri net model for the collaborative task of the multi-manipulator teleoperation system, and the Petri net model is established. Task simulation, generate corresponding action instructions, and generate collaborative task planning steps.
CN201810047259.XA 2018-01-18 2018-01-18 Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system Active CN108393884B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810047259.XA CN108393884B (en) 2018-01-18 2018-01-18 Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810047259.XA CN108393884B (en) 2018-01-18 2018-01-18 Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system

Publications (2)

Publication Number Publication Date
CN108393884A CN108393884A (en) 2018-08-14
CN108393884B true CN108393884B (en) 2021-01-05

Family

ID=63094711

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810047259.XA Active CN108393884B (en) 2018-01-18 2018-01-18 Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system

Country Status (1)

Country Link
CN (1) CN108393884B (en)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109408157B (en) * 2018-11-01 2022-03-04 西北工业大学 Method and device for determining multi-robot cooperative task
EP3753684B1 (en) * 2019-06-21 2022-08-10 Robert Bosch GmbH Method and system for robot manipulation planning
CN110941283B (en) * 2019-11-20 2022-07-05 西北工业大学 A collaborative optimal configuration method for heterogeneous UAV swarms based on mission requirements
CN111208834A (en) * 2020-02-27 2020-05-29 金陵科技学院 Full-process unattended intelligent vehicle loading and transporting process modeling method
CN111352421B (en) * 2020-03-04 2022-08-12 西北工业大学 A Trajectory Generation Method for Cooperative Inspection of Multiple Mobile Units
CN111367314B (en) * 2020-03-09 2021-07-27 西北工业大学 A collaborative capture method for space non-cooperative targets based on multi-spacecraft formation
CN111427264B (en) * 2020-03-15 2021-12-14 中国地质大学(武汉) A Neural Adaptive Fixed Time Control Method for Complex Telemanipulation Technology
CN112247962B (en) * 2020-10-19 2021-10-08 中国科学技术大学 Human-machine game control method and system for upper limb wearable robot
CN114030222B (en) * 2021-11-04 2023-12-01 温州大学 Visualized stamping line multi-machine coordination trajectory optimization method and system
CN114545898A (en) * 2022-01-21 2022-05-27 大唐互联科技(武汉)有限公司 Unmanned aerial vehicle trajectory verification method and system based on petri-net model
CN114912775B (en) * 2022-04-27 2023-03-24 北京航天飞行控制中心 Teleoperation planning method and system for granular management behavior duration
CN115437372B (en) * 2022-08-10 2023-07-18 中国科学院自动化研究所 Robot path planning method, device, electronic equipment and storage medium
CN116968037B (en) * 2023-09-21 2024-01-23 杭州芯控智能科技有限公司 Multi-mechanical-arm cooperative task scheduling method
CN117644520B (en) * 2024-01-29 2024-05-10 北京市农林科学院智能装备技术研究中心 Multi-arm robot picking task planning method, device, electronic equipment and medium
CN119141553B (en) * 2024-11-11 2025-02-21 潍柴动力股份有限公司 Multi-mechanical arm path planning method, control method, storage medium and electronic equipment

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10263957A (en) * 1997-03-25 1998-10-06 Ricoh Co Ltd Assembling device
CN101844353A (en) * 2010-04-14 2010-09-29 华中科技大学 Teleoperation task planning and simulation method for mechanical arm/dexterous hand system
CN106654987A (en) * 2016-11-18 2017-05-10 华北电力大学(保定) Power line multi-robot collaborative inspection method
CN107020635A (en) * 2017-05-04 2017-08-08 中国电子科技集团公司第三十二研究所 Method for operating multi-master-node robot operating system on multiple robots

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10101721B2 (en) * 2015-10-22 2018-10-16 Macau University Of Science And Technology System and method for determining an optimized schedule of a production line

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10263957A (en) * 1997-03-25 1998-10-06 Ricoh Co Ltd Assembling device
CN101844353A (en) * 2010-04-14 2010-09-29 华中科技大学 Teleoperation task planning and simulation method for mechanical arm/dexterous hand system
CN106654987A (en) * 2016-11-18 2017-05-10 华北电力大学(保定) Power line multi-robot collaborative inspection method
CN107020635A (en) * 2017-05-04 2017-08-08 中国电子科技集团公司第三十二研究所 Method for operating multi-master-node robot operating system on multiple robots

Also Published As

Publication number Publication date
CN108393884A (en) 2018-08-14

Similar Documents

Publication Publication Date Title
CN108393884B (en) Petri network-based collaborative task planning method for multi-mechanical-arm teleoperation system
Carriker et al. Path planning for mobile manipulators for multiple task execution
Vick et al. Robot control as a service—towards cloud-based motion planning and control for industrial robots
Mayer et al. Automation of robotic assembly processes on the basis of an architecture of human cognition
Schenker Intelligent robotics for space applications
Villagrossi et al. Simplify the robot programming through an action-and-skill manipulation framework
Zieliński et al. Specification of a multi-agent robot-based reconfigurable fixture control system
Hörmann et al. A control architecture for an advanced fault-tolerant robot system
Yun et al. Optimal self assembly of modular manipulators with active and passive modules
Özdemir Hypersingularities of 3-RRR planar parallel robots
Schenker NASA research and development for space telerobotics
Azimi et al. Autonomous robotics manipulation for in-space intra-vehicle activity
Lumia Using NASREM for real-time sensory interactive robot control
Hooper et al. Computer-aided configuration of modular robotic systems
Tsuji et al. Distributed trajectory generation for cooperative multi-arm robots via virtual force interactions
Wang et al. Sliding mode switched tracking control of space robot manipulator
Pardo-Castellote et al. Experimental integration of planning in a distributed control system
Petrenko et al. Kinematic analysis anthropomorphic gripper with group drive
Ehrmanna et al. Highly flexible robotic manufacturing cell based on holistic real-time model-based control
Prasad et al. Motion control of a pair of cylindrical manipulators in a constrained 3-dimensional workspace
Freund et al. Controlling anthropomorphic kinematics as multi-agent systems
Younis et al. A Methodology for the Design of 6D Robotic Arm
Hu et al. Dual arm robot astronaut design and coordinated force control
Oridate et al. Robot Motion Planner for Under-Constrained Trajectories With Part-Specific Geometric Variances
Szabó et al. GPU Accelerated Collision Detection for Robotic Manipulators

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