A design method for the ratio mapping factor between the master and slave hands of a teleoperated robot
By calculating the scale factor KT of the expected displacement and main hand displacement vector of the slave hand, amplifying the main hand movement, the problem of small main hand working space in the remote operation robot system is solved, the task execution efficiency is improved, and the slave can work in the main hand Move to the target position before the space boundary.
Patent Information
- Application Number
- CN202211409096.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-11-11
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-11-11
AI Technical Summary
In the existing remote operation robot system, the work space of the master hand is small, which makes it difficult to achieve fast and effective slave hand movements, especially when the master hand reaches the boundary of the workspace. Establish pose mapping to affect task execution efficiency.
By calculating the expected displacement vector of the slave hand and the master hand displacement vector, the minimum master-slave hand proportional mapping factor KT is determined to ensure that the slave hand can move to the target position before the master hand reaches the workspace boundary. The formula KT=b(|Ts|/| Tm) Amplify, the recommended coefficient b is greater than 1 to prevent the master hand movement from reaching the boundary, and enter the master and slave robot system.
Effectively utilize the main hand movement space, improve the task execution efficiency of remote operation robots, ensure that the slave can move to the target position in front of the main hand work space boundary, breaking through the limitation of the small main hand work space.
Smart Images

Figure CN115648161B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of teleoperated robots, in particular to a design method for master-slave hand ratio mapping factors of teleoperated robots. Background Art
[0002] Teleoperated robots, also known as master-slave robots, are a technology in which a person controls a master hand and then indirectly controls a slave robot (slave hand) to achieve remote operation. With the expansion of robot application fields, robots are always faced with unpredictable operation tasks in dangerous and unstructured environments. Compared with traditional robot autonomous operation methods, remote operation methods show great potential in assisting operators to perform and complete complex and uncertain tasks. As a tool for humans to break through spatial limitations and complete specific tasks, teleoperated robots have been widely used in telemedicine, sea and air exploration, mineral mining, remote experiments, bomb disposal and other fields.
[0003] A common master-slave robot system usually consists of a six-degree-of-freedom master hand and a six-degree-of-freedom manipulator, and the six-degree-of-freedom manipulator acts as a slave hand to follow the master hand. However, the workspace of the master hand is very small compared to the workspace of the slave hand. If a master-slave robot system with a 1:1 master-slave mapping is used, it is difficult to quickly control the master hand to move the slave hand manipulator to a longer distance, because when the master hand reaches the boundary of the workspace, the slave hand has not yet moved to the target position. Generally, if the master hand reaches the boundary of the workspace, it is necessary to disconnect the master-slave posture mapping relationship, move the master hand to the other side of its workspace, and then re-establish the master-slave posture mapping, and then continue to move the master hand to make the slave hand manipulator continue to move toward the target position until the slave hand manipulator moves to the target position. The whole process often requires repeated connection and disconnection of the master-slave posture mapping, which is inconvenient to operate. In order to ensure the large-scale spatial movement of the slave manipulator of the master-slave robot system, the prior art often adopts a master-slave hand ratio mapping relationship with K>1, but the existing method of adjusting the ratio mapping factor K is only adjusted based on human experience, and there is no standardized method that can select the master-slave hand ratio mapping factor K according to actual task requirements. Summary of the invention
[0004] The purpose of the present invention is to provide a method for designing the proportional mapping factor of the master and slave hands of a teleoperated robot. The proportional mapping factor K calculated by the method of the present invention is T Amplifying the movement of the master hand can ensure that the slave hand can move to the target position before the master hand reaches the boundary of its workspace, thereby making full use of the master hand's movement space, breaking through the limitation of the small workspace of the master hand of the teleoperated robot system, and improving the task execution efficiency of the teleoperated robot.
[0005] The objective of the present invention is achieved through the following technical solutions:
[0006] A method for designing a master-slave hand ratio mapping factor of a teleoperated robot comprises the following steps:
[0007] Step 1: Get the spatial coordinate P from the end of the hand s0 and the spatial coordinates P of the target point moved from the hand s1 , and calculate the expected displacement vector T from the hand s :
[0008] T s =P s1 -P s0 (1);
[0009] Step 2: T s Vector normalization yields the unit vector T of the desired displacement vector from the hand u ;
[0010] Step 3: Get the current position P of the main hand m0 , and combined with T u Get the target position P with the main hand m1 Relational formula:
[0011] P m1 =P m0 +nT u (3);
[0012] In the above formula (3), n ≥ 1 and is a constant, and the initial value n1 of n is set to 1;
[0013] Set the step value a of n and calculate P according to the above formula (3): m1 , each time P is calculated m1 After that, it is necessary to determine whether it is within the boundary of the main hand workspace. If P m1 In the main hand workspace, the value of n becomes its original value plus the step value a, that is, n i+1 =n i +a, and n i+1 Continue substituting into formula (3) until the calculated P m1 When it is not in the working space, the displacement vector T of the master hand is calculated according to the following formula (4): m :
[0014] T m =(na)T u (4);
[0015] In the above formula (4), n' is the value of n calculated last time;
[0016] Step 4: Determine T m Then, combine the T in step 1 s Determine the minimum master-slave hand ratio mapping factor:
[0017] K≥|Ts | / |T m | (5);
[0018] Step 5: Determine the final recommended proportional mapping factor K T The value of:
[0019] K T =b(|T s | / |T m |) (6);
[0020] In the above formula (6), b is the recommended coefficient and is greater than 1
[0021] Step 6: K T Enter the master-slave robot system.
[0022] In step 2, T is calculated according to formula (2). s Vector normalization yields the unit vector T of the desired displacement vector from the hand u :
[0023]
[0024] In step 5, the recommended coefficient b is preferably 1.2.
[0025] The master hand working space is a cube.
[0026] The advantages and positive effects of the present invention are:
[0027] 1. The proportional mapping factor K calculated by the method of the present invention T Amplifying the movement of the master hand can ensure that the slave hand can move to the target position before the master hand reaches the boundary of its workspace, thereby making full use of the master hand's movement space, breaking through the limitation of the small workspace of the master hand of the teleoperated robot system, and improving the task execution efficiency of the teleoperated robot.
[0028] 2. The data of the method of the present invention is easy to obtain and simple to implement. BRIEF DESCRIPTION OF THE DRAWINGS
[0029] Figure 1 is a schematic diagram of the process of the present invention,
[0030] Figure 2 It is a schematic diagram of various variables of the master and slave hands of the present invention. DETAILED DESCRIPTION
[0031] The present invention will be further described below in conjunction with the accompanying drawings.
[0032] like Figure 2FIG. 1 is a spatial Cartesian coordinate system. All vectors and points described below are described relative to this coordinate system. For the convenience of description, the slave robot arm will be referred to as the “slave arm” in the following text. Figure 2 As shown, the present invention starts from the initial position of the hand and is denoted as P s0 , the hand target position is recorded as P s1 , from the hand displacement vector Figure 2 Medium s0 Point to P s1 As shown by the arrow, the initial position of the main hand is recorded as P m0 , the target position of the main hand is recorded as P m1 , the displacement vector of the dominant hand is denoted as T m ,like Figure 2 From P m0 Departure direction P m1 As shown by the arrow, Figure 2 The cube in the figure is the main workspace, where P m1 It is on the boundary of the master hand's workspace (i.e., one face of the cube).
[0033] The method of the present invention comprises the following steps:
[0034] Step 1: Read the spatial coordinates P of the end of the current slave hand (i.e., slave arm) according to the slave arm control system s0 , using visual detection technology (visual camera) to obtain the spatial coordinates P of the target point moving from the hand s1 , use the following formula (1) to obtain the expected displacement vector T from the hand s :
[0035] T s =P s1 -P s0 (1);
[0036] Step 2: Use formula (2) to calculate T s Vector normalization yields the unit vector T of the desired displacement vector from the hand u :
[0037]
[0038] like Figure 2 As shown, T u From P s0 The departure is indicated by the shorter arrow;
[0039] Step 3: Use the master hand robot control system to obtain the current position P of the master hand m0 , then combined with T u Get the target position P with the main hand m1 Relational formula:
[0040] P m1 =Pm0 +nT u (3);
[0041] In the above formula (3), n ≥ 1 and is a constant, and the initial value of n is set to 1;
[0042] Set the step value a of n and calculate P according to the above formula (3): m1 , each time P is calculated m1 After that, we need to judge whether it is within the boundary of the master hand's workspace. If P m1 In the main hand workspace, the value of n becomes its original value plus the step value a, that is, n i+1 =n i +a, and n i+1 Continue substituting into formula (3) until the calculated P m1 When not in the workspace, the master hand displacement vector T is calculated according to the following formula (4): m :
[0043] T m =(na)T u (4);
[0044] In the above formula (4), a is the step value, and n' is the n value calculated last time; in this embodiment, a=0.01;
[0045] Step 4: Determine T m Then, combine the T in step 1 s Determine the minimum master-slave hand ratio mapping factor:
[0046] K≥|T s | / |T m | (5);
[0047] Where K = |T s | / |T m | is the minimum scale factor that ensures that the master hand moves from its initial position to the target position before reaching the boundary;
[0048] Step 5: Determine the final recommended proportional mapping factor K T The value of:
[0049] K T =b(|T s | / |T m |) (6);
[0050] In the above formula (6), b is a recommended coefficient and is greater than 1. In this embodiment, b = 1.2. If the proportional mapping factor takes its minimum value K = |T s | / |T m|, although it can ensure that the master hand moves once and the slave hand can move to the distant target position, the master hand will be close to the boundary of its workspace at this time, so the general proportional mapping factor K cannot take its minimum value to prevent the master hand from moving to the boundary of its workspace and reaching the limit of the structure. Therefore, the present invention sets a recommended coefficient to avoid the above situation.
[0051] Step 6: Map the determined master-slave hand ratio to factor K T Input the master-slave robot system. Use the proportional mapping factor K calculated by the method of the present invention T Amplifying the movement of the master hand can ensure that the slave hand can move to the target position before the master hand reaches the boundary of its workspace, thereby making full use of the master hand's movement space, breaking through the limitation of the small workspace of the master hand of the teleoperated robot system, and improving the task execution efficiency of the teleoperated robot.
Claims
1. A method for designing master-slave hand ratio mapping factors of a teleoperated robot, characterized in that: The steps include: Step 1: Get the spatial coordinate P from the end of the hand s0 and the spatial coordinates P of the target point moved from the hand s1 , and calculate the expected displacement vector T from the hand s : T s =P s1 -P s0 (1); Step 2: T s Vector normalization yields the unit vector T of the desired displacement vector from the hand u ; Step 3: Get the current position P of the main hand m0 , and combined with T u Get the target position P with the main hand m1 Relational formula: P m1 =P m0 +nT u (3); In the above formula (3), n ≥ 1 and is a constant, and the initial value n1 of n is set to 1; Set the step value a of n and calculate P according to the above formula (3): m1 , each time P is calculated m1 After that, it is necessary to determine whether it is within the boundary of the main hand workspace. If P m1 In the main hand workspace, the value of n becomes its original value plus the step value a, that is, n i+1 =n i +a, and n i+1 Continue substituting into formula (3) until the calculated P m1 When it is not in the working space, the displacement vector T of the master hand is calculated according to the following formula (4): m : T m =(n’-a)T u (4): In the above formula (4), n' is the value of n calculated last time; Step 4: Determine T m Then, combine the T in step 1 s Determine the minimum master-slave hand ratio mapping factor: K≥|T s | / |T m | (5); Step 5: Determine the value of the final recommended proportional mapping factor KT: K T =b(|T s | / |T m |) (6); In the above formula (6), b is the recommended coefficient and is greater than 1 Step 6: K T Enter the master-slave robot system.
2. The method for designing the master-slave hand ratio mapping factor of a teleoperated robot according to claim 1, characterized in that: In step 2, T is calculated according to formula (2). s Vector normalization yields the unit vector T of the desired displacement vector from the hand u :
3. The method for designing master-slave hand ratio mapping factors of a teleoperated robot according to claim 1, characterized in that: In step 5, the recommended coefficient b is preferably 1.
2.
4. The method for designing the master-slave hand ratio mapping factor of a teleoperated robot according to claim 1, characterized in that: The master hand working space is a cube.
