Safe man-machine interaction method of ultrasonic scanning robot and ultrasonic scanning robot
By setting torque and six-dimensional force sensors in the ultrasonic scanning robot, building momentum observer and designing redundant collision avoidance control, the problem that the ultrasonic scanning robot cannot respond to collisions in multi-point collision detection scenarios is solved, and the scanning is achieved Safety human-computer interaction that effectively avoids collisions during the inspection process.
Patent Information
- Application Number
- CN202411100685.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-26
AI Technical Summary
The existing ultrasonic scanning robot cannot simultaneously realize the robot's terminal scanning work tasks and avoid collision reactions in force control mode, especially in multi-point collision detection scenarios, which cannot effectively respond to unexpected collisions.
By setting up torque sensors and end six-dimensional force sensors in each joint of the ultrasonic scanning robot, a momentum observer with active passive contact force separation is constructed, an unexpected collision contact force is detected, and a control method based on zero space redundancy collision avoidance is designed. Select the appropriate control mode to avoid collisions, including normal operation mode and abnormal operation mode.
It realizes effective detection of collisions, positioning contact points, responding to external contact forces, driving the robot into redundant collision avoidance mode, avoiding external force interference, maintaining stable contact force between the ultrasonic probe and the patient, and ensuring human-computer interaction Security.
Smart Images

Figure CN119024837A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of human-computer interaction, and relates to a safe human-computer interaction method for an ultrasonic scanning robot and an ultrasonic scanning robot. Background Art
[0002] Ultrasound scanning is a simple and effective means of examination. As people pay more attention to their health, the demand for ultrasound scanning is increasing. The ultrasound scanning robot uses an ultrasound probe fixed at the end of the robotic arm to perform ultrasound scanning on the patient to obtain ultrasound images of the lesion.
[0003] Human-robot interaction (HRI) is increasingly becoming an essential element of ultrasound scanning robots. At all times, monitoring collisions and avoiding collisions are essential to ensure the safety of the person being examined. Detecting, isolating, identifying collisions and ultimately establishing response strategies play a key role. Unlike traditional industrial robots, medical robots not only need to share the workspace with humans, but also need to come into physical contact with the human body to complete their tasks. This places high demands on the human-robot interaction capabilities of medical robots. When an ultrasound robot performs a scanning task, the ultrasound probe needs to come into contact with the patient's body. In the event of an external collision, the robot must have multi-point contact collision detection capabilities to perform subsequent collision responses and safety interaction measures.
[0004] The existing ultrasonic scanning robot collision monitoring is mostly based on the premise of single-point collision. However, in the real ultrasonic scanning scenario, in order to maintain high-quality ultrasonic images, the robot needs to work in an environment of long-term stable contact with the human body. At this time, the robot works in force control mode. The existing ultrasonic scanning robot has poor performance in multi-point collision detection scenarios in force control mode. In addition, the robot response strategy established for unexpected collisions often requires interrupting the scanning task at the end of the robot (such as emergency stop, zero-force dragging, etc.), and it is impossible to achieve the scanning task at the end of the robot and avoid collision response at the same time. Summary of the invention
[0005] The technical solution of the present invention is used to solve the problem that the existing ultrasonic scanning robot cannot simultaneously achieve the robot end scanning task and avoid collision reaction.
[0006] The present invention solves the above technical problems through the following technical solutions:
[0007] A safe human-machine interaction method for an ultrasonic scanning robot, comprising:
[0008] Collision detection, redundant robot safety control method design and threshold and robot control mode strategy selection;
[0009] The collision detection method is as follows: by setting a torque sensor at each joint of the ultrasonic scanning robot and a six-dimensional force sensor at the end of the robot, the joint torque information of the robot in the ultrasonic scanning working state and the active scanning contact force F generated by the ultrasonic probe clamped at the end of the robot and the human skin are respectively obtained. scan , construct a momentum observer with active and passive contact force separation, and separate the active scanning contact force F scan Separation from the momentum observer to calculate the unexpected collision contact force F ext , the collision position vector r corresponding to the collision i,d and collision moment M ext ;
[0010] The design process of the redundant robot safety control method is as follows: design a normal working mode based on zero space redundant collision avoidance, and establish a collision torque M ext Zero space arm angle with robot The impedance relationship of the robot zero space arm angular acceleration is obtained The robot Cartesian and joint space Jacobian matrices are transformed and substituted into the robot dynamics equation to obtain the corresponding joint torque τ required for the robot's zero space motion. N , when the robot senses that the collision torque exceeds the threshold, the robot can avoid collision while performing normal scanning work;
[0011] Design the collision avoidance abnormal working mode, that is, when the robot senses the collision torque M ext If the threshold is not met, the collision avoidance through the null space cannot be achieved, and the active scanning force F scan Or collision force F ext When the threshold is exceeded, the current scanning task is interrupted and the robot enters a safe zero-force interaction state;
[0012] The threshold judgment and robot control mode strategy selection are as follows:
[0013] (1) When F scan <F s,res 、F ext <F e,res 、M ext <M e,res , the contact information sensed at this time does not exceed the threshold, and the ultrasonic scanning robot is in normal working mode;
[0014] (2) When F scan <F s,res 、F ext >F e,res 、M ext <M e,res When the unexpected collision contact force F is detected extExceeds the set collision contact force safety threshold F e,res , and the collision moment M ext The collision contact force safety threshold M is not exceeded e,res ,At this time, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode;
[0015] (3) When F scan <F s,res 、M ext >M e,res When the corresponding collision torque M is detected ext Exceeding the collision torque safety threshold M e,res , the ultrasonic scanning robot switches to the normal working mode based on zero-space redundancy collision avoidance, and the ultrasonic scanning robot continues to perform the scanning task while avoiding external collision contact;
[0016] (4) When F scan >F s,res When the active scanning contact force F between the ultrasound scanning robot and the patient is detected scan Exceeding the active scanning contact force safety threshold F s,res ,In order to protect the safety of ultrasonic scanning, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode;
[0017] Among them, F s,res 、F e,res 、M e,res They are active scanning contact force safety threshold, collision contact force safety threshold, and collision torque safety threshold.
[0018] Furthermore, the method for constructing a momentum observer with active and passive contact force separation is as follows:
[0019]
[0020]
[0021]
[0022] In the formula, K α is the diagonal gain matrix of the observer, J(q) represents the robot Jacobian matrix, p(t) is the joint momentum at time t, p(0) is the joint momentum at time 0, M(q) is the positive definite symmetric robot inertia matrix, Represent the robot joint angle and angular velocity vector respectively, are the Coriolis force and centrifugal force vectors, g(q) is the joint gravity vector, τ r is the joint torque of the robot.
[0023] Furthermore, the contact force Fscan The method of separating from the momentum observer is as follows: the active scanning contact force F generated when the ultrasound probe contacts the human skin surface is sensed by a six-dimensional force or torque sensor installed at the end of the robot. scan , using the transpose of the robot Jacobian matrix to actively scan the contact force F scan Equivalent to the joint space and separated from the designed momentum observer.
[0024] Furthermore, the unexpected collision contact force F cxt The calculation formula is as follows:
[0025]
[0026] In the formula, f i and m i They represent the estimated collision contact force and contact moment vector respectively. Since the joint Jacobian matrix of the redundant robot is not always full rank, the formula is adopted The pseudo-inverse calculation form, J i is the Jacobian matrix of the robot joints.
[0027] Furthermore, the collision position vector r corresponding to the collision occurs i,d and collision moment M ext The calculation formulas are as follows:
[0028] ri,d=(ST(fi))*m(5)
[0029]
[0030] In the formula, S T (f i ) represents the antisymmetric matrix, and r is the distance between the robot wrist joint and the shoulder joint.
[0031] Furthermore, when the ultrasonic scanning robot is in the collision avoidance abnormal working mode, the robot adopts a zero-force control method with a compliant interactive characteristic. When a collision occurs, the robot moves naturally in the direction of the collision or is pulled to a safe position. The corresponding joint torque control law input is as follows:
[0032]
[0033] Among them, D d is the desired damping matrix, K d is the desired stiffness matrix of the setting, and τ is the input moment.
[0034] Furthermore, the collision moment M ext Zero space arm angle with robot The impedance relationship is as follows:
[0035]
[0036] Where M N , D N , K N are the effective inertia, damping and stiffness scalars of the desired designed robot in null space, and They correspond to the velocity and acceleration corresponding to the zero space arm angle respectively.
[0037] Furthermore, the joint torque τ required for the robot's zero-space motion is N The calculation formula is as follows:
[0038]
[0039] In the formula, is the derivative matrix of the robot’s null space Jacobian matrix, N is the null space basis matrix of the robot’s Jacobian matrix, and its relationship with the robot’s Jacobian matrix J(q) is J(q)N(q) T =O; represents the expected acceleration of the zero-space arm angle, and is set to 0, then
[0040] An ultrasonic scanning robot comprises a memory and a processor, wherein the memory is used to store a program that supports the processor to execute the above-mentioned ultrasonic scanning robot safe human-computer interaction method, and the processor is configured to execute the program stored in the memory.
[0041] A storage medium having a computer program stored thereon, characterized in that when the computer program is run by a processor, the steps of the above-mentioned ultrasonic scanning robot safe human-computer interaction method are executed.
[0042] The advantages of the present invention are:
[0043] The method of the present invention comprises: collision detection, redundant robot safety control method design and threshold and robot control mode strategy selection, the collision detection method locates the collision contact point and accurately estimates the external contact force by effectively distinguishing the robot end scanning force and the unexpected collision contact force; combining the identification and evaluation of the external contact force, designing the redundant robot safety control method and establishing the human-machine safety interaction reaction strategy; constructing the impedance model of the robot corresponding to the contact external force torque and the zero space angle, responding to the external contact, driving the robot to enter the normal working mode based on zero space redundant collision avoidance, utilizing the redundant degrees of freedom to avoid the interference of the external force, and maintaining the stable contact force between the ultrasound probe and the patient; for the collision that cannot be avoided by utilizing the redundancy or the abnormality caused by the active contact force, driving the robot to enter the collision avoidance abnormal working mode to fully protect the safety of the human-machine interaction. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] Figure 1 This is a collision scenario of the ultrasonic scanning robot in an embodiment of the present invention in a scanning scenario;
[0045] Figure 2 is a schematic diagram of the robot zero-space motion in a normal working mode based on zero-space redundant collision avoidance according to an embodiment of the present invention;
[0046] Figure 3 is a flow chart of a threshold determination and robot mode selection strategy of an ultrasonic scanning robot according to an embodiment of the present invention;
[0047] Figure 4 It is a diagram showing the motion effect of avoiding the collision source direction of the ultrasonic scanning robot safe human-machine interaction method according to an embodiment of the present invention. DETAILED DESCRIPTION
[0048] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution in the embodiments of the present invention will be clearly and completely described below in combination with the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0049] The technical solution of the present invention is further described below in conjunction with the accompanying drawings and specific embodiments:
[0050] Embodiment 1
[0051] A safe human-machine interaction method for an ultrasonic scanning robot according to an embodiment of the present invention includes:
[0052] 1. Collision Detection
[0053] like Figure 1 As shown in FIG, by setting a torque sensor at each joint of the ultrasonic scanning robot and a six-dimensional force sensor at the end of the robot, the joint torque information of the robot in the ultrasonic scanning working state and the active scanning contact force F generated by the ultrasonic probe clamped at the end of the robot and the human skin are obtained respectively. scan , construct a momentum observer with active and passive contact force separation, and separate the active scanning contact force F scan Separation from the momentum observer to calculate the unexpected collision contact force F ext , the collision position vector r corresponding to the collision i,d and collision moment M ext .
[0054] The method for constructing a momentum observer with active and passive contact force separation is as follows:
[0055]
[0056]
[0057]
[0058] In the formula, K α is the diagonal gain matrix of the observer, J(q) represents the robot Jacobian matrix, p(t) is the joint momentum at time t, p(0) is the joint momentum at time 0, M(q) is the positive definite symmetric robot inertia matrix, Represent the robot joint angle and angular velocity vector respectively, are the Coriolis force and centrifugal force vectors, g(q) is the joint gravity vector, τ r is the joint torque of the robot.
[0059] The unexpected collision contact force F ext The calculation formula is as follows:
[0060]
[0061] In the formula, f i and m i They represent the estimated collision contact force and contact moment vector respectively. Since the joint Jacobian matrix of the redundant robot is not always full rank, the formula is adopted The pseudo-inverse calculation form, J i is the Jacobian matrix of the robot joints.
[0062] The collision position vector r corresponding to the collision occurs i,d and collision moment M ext The calculation formulas are as follows:
[0063]
[0064]
[0065] In the formula, S T (f i ) represents the antisymmetric coefficient matrix, and r is the distance between the robot wrist joint and the shoulder joint.
[0066] The contact force F will be actively scanned scan and the unexpected collision contact force F ext The separation method is as follows: the six-dimensional force or torque sensor installed at the end of the robot senses the active scanning contact force F generated when the ultrasound probe contacts the surface of the human skin. scan , using the transpose of the robot Jacobian matrix to actively scan the contact force Fscan Equivalent to the joint space and separated from the designed momentum observer.
[0067] 2. Design of redundant robot safety control method
[0068] like Figure 2 As shown in the figure, S and W represent the positions of the robot's shoulder joint and wrist joint respectively, E represents the position of the robot's elbow joint, and the angle between the P and P planes formed by the robot's shoulder, elbow and wrist joints is is the zero space arm angle of the robot, r represents the distance between the robot wrist joint and the shoulder joint, and when the ultrasonic scanning robot senses the collision torque M during the scanning process ext When the corresponding threshold is exceeded, the robot maintains the terminal ultrasonic scanning force F through the designed normal working mode based on zero space redundancy collision avoidance. scan While the collision force F is unchanged, the line connecting the robot shoulder joint and wrist joint is ext Perform zero space motion and collision avoidance motion in the direction of.
[0069] Design the normal working mode based on zero space redundancy collision avoidance, and establish the collision moment M ext Zero space arm angle with robot The impedance relationship of the robot zero space arm angular acceleration is obtained The robot Cartesian and joint space Jacobian matrices are transformed and substituted into the robot dynamics equation to obtain the corresponding joint torque τ required for the robot's zero space motion. N , when the robot senses the collision torque M ext When the threshold is exceeded, the robot can avoid collisions while performing normal scanning work.
[0070] Design the collision avoidance abnormal working mode, that is, when the robot senses the collision torque M ext If the threshold is not met, the collision avoidance through the null space cannot be achieved, and the active scanning force F scan Or collision force F ext When the threshold is exceeded, the current scanning task is interrupted and the robot enters a safe zero-force interaction state.
[0071] When the ultrasonic scanning robot is in the collision avoidance abnormal working mode, the robot adopts a zero-force control method with a compliant interactive characteristic. When a collision occurs, the robot moves naturally in the direction of the collision or is pulled to a safe position. The corresponding joint torque control law input is as follows:
[0072]
[0073] Among them, D d is the desired damping matrix, K d is the desired stiffness matrix set, is the error between the desired joint angle and the actual joint angle, and τ is the input torque.
[0074] The collision moment M ext Zero space arm angle with robot The impedance relationship is as follows:
[0075]
[0076] Where M N , D N , K N are the effective inertia, damping and stiffness scalars of the desired designed robot in null space, and They correspond to the velocity and acceleration corresponding to the zero space arm angle respectively.
[0077] The joint torque τ required for the robot's zero-space motion N The calculation formula is as follows:
[0078]
[0079] In the formula, is the derivative matrix of the robot’s null space Jacobian matrix, N is the null space basis matrix of the robot’s Jacobian matrix, and its relationship with the robot’s Jacobian matrix J(q) is J(q)N(q) T =O; represents the expected acceleration of the zero-space arm angle, and is set to 0, then
[0080] 3. Threshold judgment and robot control mode strategy selection
[0081] like Figure 3 As shown, the threshold judgment and robot mode selection strategy include: collision avoidance abnormal working mode (Rabort), normal working mode based on zero space redundancy collision avoidance (Rnull) and normal working mode (none). Specifically, the threshold judgment and robot mode selection strategy are shown in Table 1 below.
[0082] Table 1 Threshold judgment and robot mode selection strategy
[0083]
[0084] (1) When F scan <F s,res 、F ext <F e,res 、M ext <M e,res , the contact information sensed at this time does not exceed the threshold, and the ultrasonic scanning robot is in normal working mode;
[0085] (2) When F scan <F s,res 、F ext >F e,res 、M ext <M e,res When the unexpected collision contact force F is detected ext Exceeds the set collision contact force safety threshold F e,res , and the collision moment M ext The collision contact force safety threshold M is not exceeded e,res ,At this time, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode;
[0086] (3) When F scan <F s,res 、M ext >M e,res When the corresponding collision torque M is detected ext Exceeding the collision torque safety threshold M e,res , the ultrasonic scanning robot switches to the normal working mode based on zero-space redundancy collision avoidance, and the ultrasonic scanning robot continues to perform the scanning task while avoiding external collision contact;
[0087] (4) When F scan >F s,res When the active scanning contact force F between the ultrasound scanning robot and the patient is detected scan Exceeding the active scanning contact force safety threshold F s,res ,In order to protect the safety of ultrasonic scanning, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode;
[0088] Among them, F s,res 、F e,res 、M e,res They are active scanning contact force safety threshold, collision contact force safety threshold, and collision torque safety threshold.
[0089] like Figure 4 As shown, the robot senses the collision torque M generated by the external collision relative to the robot arm plane. ext When the set threshold is exceeded, the robot enters the redundant collision avoidance control mode. Without interfering with the main task of the terminal ultrasonic probe scanning, the robot is driven to move in the direction of avoiding the source of the collision force, thereby achieving the effect of eliminating the collision contact force while maintaining the terminal scanning.
[0090] Embodiment 2
[0091] An ultrasonic scanning robot comprises a memory and a processor, wherein the memory is used to store a program that supports the processor to execute the ultrasonic scanning robot safe human-computer interaction method in embodiment one, and the processor is configured to execute the program stored in the memory.
[0092] Embodiment 3
[0093] A storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the ultrasonic scanning robot safe human-computer interaction method in embodiment 1 are executed.
[0094] The above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims
1. A safe human-machine interaction method for an ultrasonic scanning robot. It is characterized in that include: Collision detection, redundant robot safety control method design and threshold and robot control mode strategy selection; The collision detection method is as follows: by setting a torque sensor at each joint of the ultrasonic scanning robot and a six-dimensional force sensor at the end of the robot, the joint torque information of the robot in the ultrasonic scanning working state and the active scanning contact force F generated by the ultrasonic probe clamped at the end of the robot and the human skin are respectively obtained. scan , construct a momentum observer with active and passive contact force separation, and separate the active scanning contact force F scan Separation from the momentum observer to calculate the unexpected collision contact force F ext , the collision position vector r corresponding to the collision i,d and collision moment M ext ; The design process of the redundant robot safety control method is as follows: design a normal working mode based on zero space redundant collision avoidance, and establish a collision torque M ext Zero space arm angle with robot The impedance relationship of the robot zero space arm angular acceleration is obtained The robot Cartesian and joint space Jacobian matrices are transformed and substituted into the robot dynamics equation to obtain the corresponding joint torque τ required for the robot's zero space motion. N , when the robot senses that the collision torque exceeds the threshold, the robot can avoid collision while performing normal scanning work; Design the collision avoidance abnormal working mode, that is, when the robot senses the collision torque M ext If the threshold is not met, the collision avoidance through the null space cannot be achieved, and the active scanning force F scan Or collision force F ext When the threshold is exceeded, the current scanning task is interrupted and the robot enters a safe zero-force interaction state; The threshold judgment and robot control mode strategy selection are as follows: (1) When F scan <F s,res 、F ext <F e,res 、M ext <M e,res , the contact information sensed at this time does not exceed the threshold, and the ultrasonic scanning robot is in normal working mode; (2) When F scan <F s,res 、F ext >F e,res 、M ext <M e,res When the unexpected collision contact force F is detected ext Exceeds the set collision contact force safety threshold F e,res , and the collision moment M ext The collision contact force safety threshold M is not exceeded e,res ,At this time, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode; (3) When F scan <F s,res 、M ext >M e,res When the corresponding collision torque M is detected ext Exceeding the collision torque safety threshold M e,res , the ultrasonic scanning robot switches to the normal working mode based on zero-space redundancy collision avoidance, and the ultrasonic scanning robot continues to perform the scanning task while avoiding external collision contact; (4) When F scan >F s,res When the active scanning contact force F between the ultrasound scanning robot and the patient is detected scan Exceeding the active scanning contact force safety threshold F s,res ,In order to protect the safety of ultrasonic scanning, the ultrasonic scanning robot interrupts the scanning task and enters the collision avoidance abnormal working mode; Among them, F s,res 、F e,res 、M e,res They are active scanning contact force safety threshold, collision contact force safety threshold, and collision torque safety threshold.
2. The safe human-machine interaction method of the ultrasonic scanning robot according to claim 1, It is characterized in that The method for constructing a momentum observer with active and passive contact force separation is as follows: In the formula, K α is the diagonal gain matrix of the observer, J(q) represents the robot Jacobian matrix, p(t) is the joint momentum at time t, p(0) is the joint momentum at time 0, M(q) is the positive definite symmetric robot inertia matrix, q, Respectively represent the robot joint angle and angular velocity vector, are the Coriolis force and centrifugal force vectors, g(q) is the joint gravity vector, τ r is the joint torque of the robot.
3. The safe human-machine interaction method of the ultrasonic scanning robot according to claim 1, It is characterized in that The contact force F will be actively scanned scan The method of separating from the momentum observer is as follows: the active scanning contact force F generated when the ultrasound probe contacts the human skin surface is sensed by a six-dimensional force or torque sensor installed at the end of the robot. scan , using the transpose of the robot Jacobian matrix to actively scan the contact force F scan Equivalent to the joint space and separated from the designed momentum observer.
4. The safe human-machine interaction method of the ultrasonic scanning robot according to claim 1, It is characterized in that The unexpected collision contact force F ext The calculation formula is as follows: In the formula, f i and m i They represent the estimated collision contact force and contact moment vector respectively. Since the joint Jacobian matrix of the redundant robot is not always full rank, the formula is adopted The pseudo-inverse calculation form, J i is the Jacobian matrix of the robot joints.
5. The safe human-machine interaction method of the ultrasonic scanning robot according to claim 4, It is characterized in that The collision position vector r corresponding to the collision occurs i,d and collision moment M ext The calculation formulas are as follows: r i,d =(S T (f i )) # m i (5) In the formula, S T (f i ) represents the antisymmetric matrix, and r is the distance between the robot wrist joint and the shoulder joint.
6. The safe human-machine interaction method of the ultrasonic scanning robot according to claim 1, It is characterized in that When the ultrasonic scanning robot is in the collision avoidance abnormal working mode, the robot adopts a zero-force control method with a compliant interactive characteristic. When a collision occurs, the robot moves naturally in the direction of the collision or is pulled to a safe position. The corresponding joint torque control law input is as follows: Among them, D d is the desired damping matrix, K d is the desired stiffness matrix of the setting, and τ is the input moment.
7. The ultrasonic scanning robot safe human-machine interaction method according to claim 1, It is characterized in that The collision moment M ext Zero space arm angle with robot The impedance relationship is as follows: Where M N , D N , K N are the effective inertia, damping and stiffness scalars of the desired designed robot in null space, and They correspond to the velocity and acceleration corresponding to the zero space arm angle respectively.
8. The safe human-machine interaction method of an ultrasonic scanning robot according to claim 1, It is characterized in that The joint torque τ required for the robot's zero-space motion N The calculation formula is as follows: In the formula, is the derivative matrix of the robot’s null space Jacobian matrix, N is the null space basis matrix of the robot’s Jacobian matrix, and its relationship with the robot’s Jacobian matrix J(q) is J(q)N(q) T =O; represents the expected acceleration of the zero-space arm angle, and is set to 0, then 9. An ultrasonic scanning robot, comprising a memory and a processor, It is characterized in that The memory is used to store a program that supports the processor to execute the ultrasonic scanning robot safe human-computer interaction method according to any one of claims 1 to 8, and the processor is configured to execute the program stored in the memory.
10. A storage medium having a computer program stored thereon, It is characterized in that When the computer program is executed by the processor, the steps of the ultrasonic scanning robot safe human-computer interaction method according to any one of claims 1 to 8 are executed.
