Force detection device of cart

By designing limit and force transmission mechanisms in the surgical robot cart, over-range protection of the force detection unit is achieved, and the deformation and damage of the force sensor in the case of overload is solved, which extends the service life of the equipment and improves force detection accuracy and reliability.

CN118896718APending Publication Date: 2024-11-05SHENZHEN JINGFENG MEDICAL TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202310492735.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-05-04
Publication Date
2024-11-05

AI Technical Summary

Technical Problem

Existing force sensors are susceptible to overload or impact during the use of surgical robot carts, resulting in plastic deformation and damage, which cannot be repaired on site, and more effective protection measures are required.

Method used

A force detection device for push carts is designed, using a limiting mechanism and a force transmission mechanism. Through structures such as sliding components and unloading holes, the over-range protection of the force detection unit is achieved to avoid overload transmission to the force detection unit, and ensure that the Force detection is carried out within the normal working range.

Benefits of technology

Effectively prevent the force detection device from deforming or damage under overload, extend the service life of the equipment, and improve the accuracy and reliability of force detection.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118896718A_ABST
    Figure CN118896718A_ABST
Patent Text Reader

Abstract

The invention discloses a force detection device for a cart, and the device comprises a stress mechanism which is used for receiving an external force, a force transmission mechanism which is fixed on the stress mechanism, a limiting mechanism which is fixedly connected with the stress mechanism, and a force detection mechanism which is fixed on the limiting mechanism. The limiting mechanism comprises a fixed seat and a sliding assembly, the sliding assembly comprises a sliding rail piece fixed to the fixed seat and a sliding piece capable of relatively moving along the sliding rail piece, and the sliding piece is arranged to move in the first freedom degree direction or the second freedom degree direction along the sliding rail piece. The first degree-of-freedom direction is perpendicular to the second degree-of-freedom direction. According to the force detection device disclosed by the invention, overload of the force detection device can be effectively prevented, and the overall rigidity performance of the stress mechanism can be obviously improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of force sensors, and in particular to a force detection device for a cart. Background Art

[0002] With the advancement of science and technology, robotic surgery systems have gradually matured and are widely used. Robotic surgery systems usually include a patient surgical platform and a doctor's console. The doctor sends control commands to the patient surgical platform through the doctor's console to achieve remote surgical operations. Before each operation begins, the patient surgical platform needs to be transferred and positioned; after each operation, the patient surgical platform needs to be transferred to a designated location in the operating room; in scenarios such as transfers between different operating rooms, doctors are required to operate and push the patient surgical platform to move. Therefore, the movement of the patient surgical platform is a relatively frequent task. At present, the patient surgical platform relies on the force sensor at the operating armrest of the cart to receive the thrust of the collected human hand, and the controller controls the rotation of the driving wheel at the bottom of the robot according to the thrust, so that the surgical platform can be transferred, or manually pushed when the battery is low. In the process of controlling the movement of the surgical robot cart, the force detection device is currently prone to overload or impact in normal use, such as leaning against the armrest, manual transfer when the battery is low, and bumping during transportation. The force sensor is plastically deformed or even damaged. The damage cannot be repaired on site, and parts can only be replaced, causing the product to be unable to be used normally. Summary of the invention

[0003] Based on this, the present application proposes a force detection device for a cart to solve the problem that the existing force detection device is easily subjected to overload or impact, etc., which may cause plastic deformation or even damage of the force sensor.

[0004] This application adopts the following technical solutions:

[0005] A force detection device for a cart, comprising: a force receiving mechanism configured to receive external force, a force transmission mechanism fixed on the force receiving mechanism, a limiting mechanism fixedly connected to the force receiving mechanism, and a force detection mechanism fixed on the limiting mechanism, wherein the limiting mechanism comprises:

[0006] A fixing seat, configured to fix the force detection mechanism;

[0007] A sliding assembly, comprising a slide rail member fixed on the fixed seat and a sliding member relatively movable along the slide rail member, wherein the sliding member is configured to move along the slide rail member in a first degree of freedom direction or in a second degree of freedom direction, wherein the first degree of freedom direction and the second degree of freedom direction are located in different dimensional directions;

[0008] The force transmission mechanism is configured to transmit the external force on the force receiving mechanism along the first degree of freedom direction or the second degree of freedom direction to the force detection mechanism, so that the force detection mechanism detects the external force in the first degree of freedom direction or the external force in the second degree of freedom direction;

[0009] The sliding member is also configured to remain stationary relative to the slide rail member when receiving external forces in other degrees of freedom directions on the force-bearing mechanism, and transmit the external forces in other degrees of freedom directions to the fixed seat, without transmitting the external forces in other degrees of freedom directions to the force detection mechanism.

[0010] In which, the force transmission mechanism also includes a force transmission seat fixedly connected to the force receiving mechanism, a force unloading hole arranged on the force transmission seat, and a force unloading part fixed on the fixed seat, the force unloading part is arranged in the force unloading hole, and the force unloading part is configured to transmit the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force receiving mechanism to the fixed seat when in contact with the force unloading hole.

[0011] In which, the force detection mechanism includes a force detection unit fixed to the fixed seat and a force transmission column fixedly connected to the force detection unit, the force transmission mechanism also includes a force transmission hole arranged on the force transmission seat, the force transmission column is arranged in the force transmission hole, and the force transmission column is configured to transmit the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism to the force detection unit when it contacts the force transmission hole.

[0012] There is a first gap between the force unloading portion and the force unloading hole, there is a second gap between the force transmission column and the force transmission hole, and the first gap is smaller than the second gap.

[0013] Wherein, the second gap is larger than the normal deformation amount of the force detection unit.

[0014] Among them, an elastic element is arranged on the side of the force transmission hole, and when the elastic element is configured to contact the force transmission column, the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism is transmitted to the force transmission column.

[0015] Wherein, the sliding assembly also includes a slide plate, which is fixed to the upper end surface of the sliding member, and the slide rail member includes a transverse slide rail in the first degree of freedom direction and a longitudinal slide rail in the second degree of freedom direction, and the transverse slide rail is perpendicular to the longitudinal slide rail.

[0016] Wherein, the transverse slide rail is fixed on the mounting groove of the fixing seat, and the upper end surface of the slide plate on the sliding member is fixedly connected to the lower end surface of the force-bearing mechanism.

[0017] Wherein, the front end surface of the force-bearing mechanism is fixedly connected to the rear end surface of the force-transmitting seat.

[0018] Wherein, the force transmission mechanism also includes a limit block, which is fixed on the fixed seat. When the limit block is configured to contact the force transmission seat, the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force-bearing mechanism is transmitted to the fixed seat.

[0019] Wherein, a third gap is arranged between the limit block and the force transmission seat, and the third gap is set according to the over-range parameter of the force detection unit, or is set by adjusting the limit block.

[0020] The present application also discloses a cart, characterized in that the cart includes a force detection device, a fixed plate and a motion actuator, the motion actuator includes a chassis and a plurality of moving wheels, the lower end surface of the fixed plate is fixedly connected to the chassis, and one side surface of the fixed plate is connected to the fixed seat.

[0021] The present application discloses a force detection device for a cart. When the force-bearing mechanism is subjected to external force, the force transmission hole transmits the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism to the force detection unit through the force transmission column. When the external force is too large and causes the force detection unit to deform too much, the force unloading hole will first contact the force unloading part, thereby transmitting the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force-bearing mechanism to the fixed seat; and the external forces in other degrees of freedom directions are transmitted to the fixed seat through the sliding assembly, so that the force detection unit is within the normal working range, the over-range protection of the force detection unit is realized, the overload of the force detection device is effectively prevented, and the transverse slide rail is arranged perpendicular to the longitudinal slide rail to achieve a significant improvement in the stiffness experience of the armrest operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] The realization of the purpose, functional features and advantages of this application will be described in conjunction with the embodiments, which will be further illustrated with reference to the accompanying drawings, in which:

[0023] Figure 1 A schematic diagram of the motion control device of the cart in this application;

[0024] Figure 2 This is a schematic diagram of the structure of the force detection device of this application;

[0025] Figure 3 This is a simplified two-dimensional schematic diagram of the chassis of the cart of this application from a top view;

[0026] Figure 4 This is a flow chart of the motion control method of the cart in this application;

[0027] Figure 5 A flow chart of the method for calculating the motion coefficient of the cart in this application;

[0028] Figure 6 This is a four-quadrant azimuth coordinate diagram divided according to the chassis coordinate system of this application;

[0029] Figure 7 A schematic diagram of the force action area division of the force detection device of the present application;

[0030] Figure 8 The force detection device of this application collects the direction of the external force and the steering principle diagram of the chassis;

[0031] Fig. 9 A flow chart for determining the motion pattern of the cart for this application;

[0032] Fig.10 Diagram of the control model for motion planning and calibration of the cart for this application.

[0033] Fig.11A This is an overall schematic diagram of Embodiment 1 of the force detection device of the present application;

[0034] Fig. 11B An exploded view of Embodiment 1 of the force detection device of the present application;

[0035] Fig. 11C An exploded view of Embodiment 1 of the force detection device of the present application;

[0036] Fig. 12A This is an overall schematic diagram of Embodiment 2 of the force detection device of the present application;

[0037] Fig. 12B An exploded view of Embodiment 2 of the force detection device of the present application;

[0038] Fig. 12C An exploded view of Embodiment 2 of the force detection device of the present application;

[0039] Fig.13A This is a schematic diagram of a method for adjusting a limit block of Embodiment 2 of the force detection device of the present application;

[0040] Fig. 13B For this application Fig.13A Schematic diagram of the method for adjusting the gap of the limit block in the X-direction;

[0041] Fig. 13C For this application Fig.13A Schematic diagram of the method for adjusting the gap of the limit block in the X+ direction;

[0042] Fig.13D For this application Fig.13A Schematic diagram of the method for adjusting the gap between the limit block in the Y+ and Y- directions. DETAILED DESCRIPTION

[0043] In this application, the terms "disposed", "provided with", and "connected" should be understood in a broad sense. For example, it can be a fixed connection, a detachable connection, or an integral structure; it can be a mechanical connection, or an electrical connection; it can be a direct connection, or an indirect connection through an intermediate medium, or it can be an internal connection between two devices, elements, or components. For those of ordinary skill in the art, the specific meanings of the above terms in this application can be understood according to specific circumstances.

[0044] The orientation or position relationship indicated by the terms "center", "longitudinal", "lateral", "length", "width", "thickness", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", "clockwise", "counterclockwise", "axial", "radial", "circumferential", etc. are based on the orientation or position relationship shown in the drawings and are only for the convenience of describing the present application and simplifying the description, and do not indicate or imply that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as a limitation on the present application.

[0045] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Thus, a feature defined as "first" or "second" may explicitly or implicitly include at least one of the features. In the description of this application, "plurality" means at least two, such as two, three, etc., unless otherwise clearly and specifically defined.

[0046] In addition, some of the above terms may be used to express other meanings in addition to indicating orientation or positional relationship. For example, the term "on" may also be used to express a certain dependency or connection relationship in some cases. For those of ordinary skill in the art, the specific meanings of these terms in this application can be understood according to specific circumstances.

[0047] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those generally understood by those skilled in the art to which this application belongs. The terms used in the specification of this application are only for the purpose of describing specific embodiments and are not intended to limit this application. The term "and / or" used herein includes any and all combinations of one or more related listed items.

[0048] In order to make the above-mentioned purpose, features and advantages of the present application more obvious and easy to understand, the specific implementation methods of the present application are described in detail below in conjunction with the accompanying drawings. In the following description, many specific details are set forth in order to fully understand the present application. However, the present application can be implemented in other ways different from those described herein, and those skilled in the art can make similar improvements without violating the connotation of the present application, so the present application is not limited by the specific embodiments disclosed below.

[0049] like Figure 1 As shown, the present application provides a cart, which mainly includes: a force detection device 52, a force-bearing mechanism and a motion actuator, a fixed plate 51, and a data output cable 53. Among them, the force-bearing mechanism includes an armrest and a switch, the armrest includes a left handgrip 60 and a right handgrip 54, the switch includes a left pressure-touch switch 58 and a right pressure-touch switch 56, and the motion actuator includes a chassis 57 and a plurality of moving wheels 59, and some or all of the plurality of moving wheels 59 are driving wheels driven by a motor.

[0050] The rear ends of the left handrail 60 and the right handrail 54 are fixedly connected to the left pressure-touch switch 58 and the right pressure-touch switch 56 by means of structural engagement. The switch is an interactive trigger switch provided to the operator, and is used to trigger the movement of the chassis 57. Specifically, there is an elastic unit inside the switch, and the elastic unit can be a spring, rubber, latex, sponge, etc. In addition, the switch can be a variable resistance pressure-touch film, a button, a switch, etc.

[0051] The front ends of the left handrail 60 and the right handrail 54 are rigidly connected to the force detection device 52. When the operator applies external force to the handrail, the external force transmission process is more direct, the force transmission loss is small, and the efficiency is higher, which has the characteristics of rapid response in control processing. In the implementation example, the external force collected by the force detection device 52 is the combined force of the left handrail 60 or the right handrail 54.

[0052] In another embodiment, the armrest position is set to Figure 1 As shown, it is on the rear side of the surgical robot cart, and can also be adjusted to the left, right or front side of the surgical robot cart. It can also be set to have no operable armrest, such as a rocker device. In one embodiment, the armrest is a split semi-arc configuration, or an integrated semi-circular, rectangular or triangular mechanical configuration. In addition, when the armrest is damaged and fails, the surgical robot cart device can detect the state of the armrest damage and failure, and the armrests of different surgical robot carts can be replaced equivalently, and the detection function can be automatically restored after the failed armrest is replaced.

[0053] The structural diagram of the force detection device 52 is shown in FIG. Figure 2As shown. The force detection device 52 includes: an upper fixed base surface L10, an external force detection surface L11, an upper fixed screw hole L12, a force detection unit 2, a lower fixed screw hole L13, a lower fixed base surface L14, and a data output cable 53. The force detection device 52 is connected to the fixed plate 51 by bolts or screws. By fixing the force detection device 52 to the handrail, a force conduction channel between the operator's hand and the force detection device 52 is established. The force detection device 52 is electrically connected to the data output cable 53, and the force detection device 52 transmits the detected external force to other devices through the data output cable 53.

[0054] In this embodiment, the force detection device 52 is arranged at the rear end position of the armrest. In another embodiment, it can also be arranged at the hand placement position of the armrest, or embedded in the armrest structure, or at any position that transmits force to the mechanical structure components.

[0055] like Figure 2 As shown, the force detection device 52 is connected to the left handrail 60 and the right handrail 54 by bolts or screws through the four upper fixing screw holes L12 on the upper fixed base surface L10. The force detection unit 2 is arranged between the upper fixed base surface L10 and the lower fixed base surface L14. The handrail transmits the external force to the upper fixed base surface L10, and then transmits it to the external force detection surface L11 of the force detection unit 2 through the upper fixed base surface L10. Only when the external force is applied or transmitted to the external force detection surface L11 can it be detected. When the external force detection surface L11 is damaged, there is a certain risk that the external force cannot be detected or cannot be detected continuously. Therefore, by setting the upper fixed base surface L10, fatigue damage to the external force detection surface L11 caused by mechanical connection and continuous force conduction effect is avoided, which plays a certain protective role. The force detection device 52 is connected to the fixing plate 51 by bolts or screws through four lower fixing screw holes L13 of the lower fixing base surface L14, and the force detection device 52 is fastened to the fixing plate 51. The lower fixing base surface L14 can be provided to avoid fatigue damage to the internal structure of the force detection device 52 caused by mechanical connection and continuous force conduction effect. The force detection device 52 transmits the detected external force through the data output cable 53.

[0056] The force detection device 52 may be a detection method based on the principle of strain resistance, a detection method based on the principle of elastic unit structure, or a force detection device based on the principle of detecting the amount of structural strain of an object subjected to external force.

[0057] The fixed plate 51 is fixedly connected to the chassis 57, and can provide structural support for the left handrail 60 and the right handrail 54. A plurality of moving wheels 59 are installed at the bottom of the chassis 57, and some or all of the plurality of moving wheels are driving wheels driven by a motor.

[0058] If some of the multiple moving wheels 59 are driving wheels, the remaining moving wheels 59 are driven wheels, and the movement of the driven wheels is not driven by the motor, but is driven by the driving wheels. In addition, some or all of the multiple moving wheels 59 can be universal wheels that can be turned freely. If some of the multiple moving wheels 59 are universal wheels, the remaining moving wheels are non-universal wheels that cannot be turned or have limited turning. For example, a common configuration of the moving wheels 59 is that some of the moving wheels 59 are both driving wheels and non-universal wheels, and the remaining moving wheels 59 are both driven wheels and universal wheels.

[0059] For example, Figure 3 As shown, Figure 3 2 is a simplified two-dimensional schematic diagram of a chassis 57 in a surgical robot cart from a top view, mainly illustrating the positional relationship of the plurality of moving wheels 59 in the chassis 57, the coordinate system X of the force detection device 52, and the coordinate system X of the force detection device 52. F Y F Z F The position relationship between the chassis coordinate system X0Y0 and the chassis coordinate system. Among them, the dimension Y0 of the chassis coordinate system is the straight dimension, and X0 is the rotation dimension. Generally, the positive direction of Y0 is the front straight direction, and the reverse direction is the rear straight direction; the positive direction of X0 is the right rotation, and the reverse direction is the left rotation. In this embodiment, the installation of the force detection device 52 is designed so that its coordinate system X F Y F Z F The rotation angle with the chassis coordinate system on the chassis plane is 0, that is, dimension X F Parallel to dimension X0, dimension Y F Parallel to dimension Y0.

[0060] In this embodiment, there are four multiple moving wheels 59, namely, the left front moving wheel M1, the right front moving wheel M2, the left rear moving wheel M3, and the right rear moving wheel M4. The multiple moving wheels 59 also include a brake device, and the control process of the brake device is as follows: due to the presence of elastic units inside the left pressure touch switch 60 and the right pressure touch switch 54, when the operator closes his hands, the switch is pressed, and the brake devices of the multiple moving wheels 59 are in an open state, and the multiple moving wheels 59 can rotate freely; when the hand is relaxed, the elastic unit bounces the switch, and the brake devices of the multiple moving wheels 59 are in a closed state, and the multiple moving wheels 59 cannot move freely.

[0061] In this embodiment, the plurality of moving wheels 59 are four and are arranged as dual drive wheels and dual driven wheels. The dual drive wheels and dual driven wheels need to satisfy the condition that the dual drive wheels are parallel to the X0 axis of the X0Y0Z0 coordinate system of the chassis 57, so the front dual drive wheels and the rear dual drive wheels are regarded as the same. For example, the left front moving wheel M1 and the right front moving wheel M2 are set as driving wheels, and the left rear moving wheel M3 and the right rear moving wheel M4 are set as driven wheels. By driving the left front moving wheel M1 and the right front moving wheel M2, the left rear moving wheel M3 and the right rear moving wheel M4 are driven, so that the left front moving wheel M1 and the right front moving wheel M2 are at different rotation speeds, so that the chassis 57 can be placed in different motion modes. When the left front moving wheel M1 and the right front moving wheel M2 rotate at the same speed, the movement mode of the chassis 57 is straight travel, that is, the cart moves forward or backward; when there is a speed difference between the left front moving wheel M1 and the right front moving wheel M2, the movement mode of the chassis 57 is rotation, that is, rotation in place or rotation while moving. Among them, a speed sensor, an acceleration sensor, an encoder is set at the motor shaft end of the driving wheel of the chassis 57, or a current sensor is installed at the motor driving end to measure the current movement speed or acceleration or position or current of the driving wheel.

[0062] A driving device is installed at the bottom of the chassis 57, and the driving device includes a first driving device D1 and a second driving device D2, which are respectively connected to the left front moving wheel M1 and the right front moving wheel M2, so as to drive the left front moving wheel M1 and the right front moving wheel M2 to move. The first driving device D1 independently drives the left front moving wheel M1, and the second driving device D2 independently drives the right front moving wheel M2. The first driving device D1 and the second driving device D2 are independent of or interlocked with the control unit of the surgical robot cart, and the control unit is a CPU or the like to coordinate the execution of instructions. The first driving device D1 and the second driving device D2 receive the motion instructions of the cart control unit and output the corresponding motion signal to the motor, so as to realize the motor driving the left front moving wheel M1 or the right front moving wheel M2. The first driving device D1 and the second driving device D2 can directly or indirectly collect the motion estimation of the left front moving wheel M1 and the right front moving wheel M2 through a speed sensor, an acceleration sensor, an encoder or a current sensor, and the motion estimation will be used as the feedback of the control model of motion planning and calibration.

[0063] By driving the left front moving wheel M1 and the right front moving wheel M2 through the first driving device D1 and the second driving device D2, the cart can have a high response characteristic when the operator controls the cart, and can quickly respond to the operator's control expectations. For example, in a surgical robot cart, it can withstand a large load and can be loaded on the surgical robot. Under the condition of loading at least one holding arm and at least one driving box, the first driving device D1 and the second driving device D2 can achieve smooth movement.

[0064] In other embodiments, the multiple moving wheels 59 can also set the left front moving wheel M1 and the right front moving wheel M2 as driven wheels, and set the left rear moving wheel M3 and the right rear moving wheel M4 as driving wheels; in other embodiments, the multiple moving wheels 59 are set to be more than 4, and all of the multiple moving wheels 59 are driving wheels, but the control driving logic of all of them are driving wheels is more complicated than double driving wheels and double driven wheels, and requires higher cost.

[0065] The present application discloses a method for controlling the motion of a cart, such as Figure 4 As shown, the method comprises the following steps:

[0066] Step S100: determining the motion coefficients of the cart in the straight dimension and the rotation dimension and the motion mode of the cart according to the external force collected by the force detection device.

[0067] Specifically, in step S100, the operator triggers the left pressure-touch switch 58 or the right pressure-touch switch 56 by applying external force, activating the movement trigger condition of the chassis 57 to enter the movable mode. At the same time, the operator can place one hand at the left handgrip 60 or the right handgrip 54, and complete the external force application trigger by the hand gripping and pressing action, or can place both hands at the left handgrip 61 and the right handgrip 55 at the same time, and complete the external force application trigger by the hand gripping and pressing action, and after the trigger, the external force is collected by the force detection device 52.

[0068] Furthermore, Figure 5 This is a flow chart of the method for calculating the motion coefficient of the cart in this application. This application determines the motion coefficient of the cart in the straight dimension and the rotation dimension according to the external force collected by the force detection device, and the calculation includes the following steps:

[0069] Step S101: Before the force detection device 52 collects external force, the force detection model of the force detection device 52 is calibrated, including but not limited to zero calibration, temperature drift processing, resolution optimization, etc., to finally obtain a stable and highly reliable multi-dimensional force decoupling model, so that the force detection device 52 can effectively collect external force. Since the force detection device often has a certain zero drift, with the uninterrupted use of the force detection device 52, the difference between the actual offset value and the recorded offset value is not necessarily very small, but there is a certain error, which will cause the detected external force to be non-zero when no external force is applied, so zero calibration is required.

[0070] In addition, after the force detection device 52 is initialized, it is necessary to monitor the temperature drift of the force detection device 52 to determine the temperature drift compensation value of the force detection device 52, and compensate the measurement value of the force detection device 52 at the next moment based on the temperature drift compensation value to determine the external force applied to the handrail.

[0071] The temperature drift compensation in the embodiment of the present application is processed as follows: after the force detection device 52 is initialized, when no external force is detected, the temperature drift compensation value is determined according to the initialization measurement value and the current measurement value of the force detection device 52. For example, the difference between the current measurement value and the initialization measurement value is calculated, and the difference is used as the temperature drift compensation value.

[0072] Optionally, the measured value at the current moment is updated according to a preset update period, where the preset update period T = at 3 +bt 2 + ct; where T is the update period, t is the natural time, and a, b and c are coefficients. The natural time can be selected as needed, for example, 0.25ms, and incremented by 0.25ms.

[0073] Temperature drift compensation value = current measurement value - initialization measurement value.

[0074] Step S102: In order to make the chassis 57 move smoothly and stably, the external force collected by the force detection device is subjected to data offset processing, filtering processing, etc. The filtering algorithm may be a low-pass filtering algorithm, a Kalman filtering algorithm, a mean filtering algorithm, a moving mean filtering algorithm, etc.

[0075] Step S103: coordinate transformation and decomposition are performed on the external force collected by the force detection device to obtain a first component of the external force in the straight dimension and a second component in the rotation dimension.

[0076] Specifically, since the output value of the external force in one direction will be affected by the input value in other directions, in order to eliminate the coupling error and improve the measurement accuracy of the force detection device 52, a multi-dimensional force decoupling operation is performed on the external force collected by the force detection device 52, and the external force in the coordinate system X of the force detection device 52 is obtained through the multi-dimensional force decoupling model. F Y F Z F The external force components in each axis.

[0077] For example, Figure 1 As shown in , the external force collected by the force detection device is converted and decomposed to obtain the chassis coordinate system X0Y0 with the straight dimension and the rotation dimension as the axis. F Y F The coordinate system X0Y0 of the chassis 57 is converted, and the converted external force is decomposed to obtain a first component Fy and a second component Fx.

[0078] The force detection device 52 itself has a coordinate system X F Y F Z FThe force detection device 52 can detect six dimensions of external force, including three mutually perpendicular dimensions X F , Y F , Z F The forces on it, and the moments about the three forces.

[0079] In order to facilitate the control of the movement of the cart, a coordinate system can be established for the cart, which can be called a cart coordinate system or a chassis coordinate system. The coordinate system can be a plane coordinate system or a three-dimensional coordinate system. If it is a plane coordinate system, the straight dimension and rotation dimension of the cart are used as axes. If it is a three-dimensional coordinate system, a dimension perpendicular to the chassis plane (i.e., the plane defined by the straight dimension and the rotation dimension) is added to the aforementioned plane coordinate system. For example Figure 1 The coordinate system X0Y0Z0 in is the three-dimensional chassis coordinate system, where the dimension Y0 of the chassis coordinate system is the straight dimension and X0 is the rotation dimension.

[0080] If the multiple moving wheels 59 are all universal wheels, the execution dimension and the rotation dimension can be defined according to needs, habits, etc. If there are non-universal wheels among the multiple moving wheels 59, the dimension in which the non-universal wheels rotate in the same direction and speed to drive the cart to move is generally taken as the straight dimension, and the rotation dimension is parallel to the chassis 57 and perpendicular to the straight dimension. In other words, the rotation dimension is generally parallel to the line connecting the paired (i.e., arranged approximately symmetrically with the central axis of the chassis as the axis) non-universal wheels, and the straight dimension is parallel to the chassis 57 and perpendicular to the rotation dimension. For example, two wheels cannot rotate or have a very limited range of rotation, and are often used as driving wheels; the remaining wheels are usually universal wheels that can rotate freely, and are often used as driven wheels. Then the dimension in which the two driving wheels rotate in the same direction and speed to drive the cart to move is the straight dimension ( Figure 3 Y0), the dimension parallel to the chassis and perpendicular to the straight-line dimension is the rotational dimension ( Figure 3 X0 in the middle). To put it another way, the rotational dimension is generally parallel to the line connecting the two drive wheels.

[0081] If the chassis coordinate system is a plane coordinate system, a dimension perpendicular to the chassis plane can be temporarily added to it when performing coordinate transformation on the external force. Regardless of whether the chassis coordinate system is a plane coordinate system or a three-dimensional coordinate system, the component of the external force in the dimension perpendicular to the chassis plane after the transformation will not be used later.

[0082] Coordinate transformation generally includes translation and rotation. Since the chassis coordinate system is only used to control the movement of the cart, its origin is only for illustration and is not actually limited. Therefore, in the coordinate transformation of the external force, translation can be omitted and only rotation can be calculated. In order to simplify the calculation, the origin of the chassis coordinate system can be directly set to the X coordinate system of the force detection device 52 itself. F Y F Z F The origin of .

[0083] In some embodiments, if the force detection device 52 is installed so that its coordinate system X F Y F Z F If the rotation angle with the chassis coordinate system on the chassis plane is 0, the coordinate transformation can be omitted.

[0084] Among the six dimensions of data fed back by the force detection device 52, three torque data can be used as redundant data or replacement data. For the redundant data, it is not necessary to process it, or use it for compensation, calibration, etc. Replacement data means that the force in some or all dimensions can be replaced by the torque centered on the force in that dimension. In addition, if the installation of the force detection device 52 is designed, its coordinate system X F Y F Z F If one of the dimensions is perpendicular to the chassis plane, we can abandon the force in that dimension and the torque data centered on the force in that dimension, and convert the external force from three-dimensional data to two-dimensional data. F perpendicular to the chassis plane, then only the external force dimension X can be used F , Y F The forces on the dimensions can be transformed and decomposed. Of course, the forces on at least one dimension can also be replaced by a moment centered on the force on that dimension.

[0085] After the coordinate transformation and decomposition of the external force by the above method, the first component Fy of the external force in the straight dimension and the second component Fx of the external force in the rotation dimension in the chassis coordinate system are obtained.

[0086] Step S104: Determine the motion coefficient in the straight dimension according to the first component, and determine the motion coefficient in the rotation dimension according to the second component. For example, the specific process is as follows:

[0087] Substitute the first component Fy and the second component Fx into the force motion model formula 1-1 respectively. The force motion model includes the first force motion model and the second force motion model to determine the motion coefficients of the cart in the straight dimension and the rotation dimension.

[0088] Substitute the first component Fy into the first force motion model to obtain the motion coefficient Ky in the straight dimension. The first force motion model is a mathematical function related to the first component Fy: b1*|F y |+b2*|F y | 2 +b3*|F y | 3 +…+b n *|F y | m ;

[0089] Substitute the second component Fx into the second force motion model to obtain the motion coefficient Kx in the rotation dimension. The second force motion model is a mathematical function related to the second component Fx: a1*|F x |+a2*|F x | 2 +a3*|F x | 3 +…+a n *|F x | n .

[0090] The force motion model can be obtained in advance based on experiments, experience, etc. During the movement of the cart, a1…a n and b1…b n The formula coefficients remain unchanged.

[0091] The motion coefficient Ky in the straight dimension is determined according to the first component Fy, and the motion coefficient Kx in the rotation dimension is determined according to the second component Fx. The functional relationship expression is:

[0092]

[0093] In the above formula 1-1, a1…a n and b1…b n Represents the formula coefficient.

[0094] Considering the poor stability of the operator's hand applying a slight external force, and the data fluctuation influence of the force detection device 52 in the case of incomplete decoupling, in order to make the response speed of the chassis 57 able to keep up with the external force applied by the operator on the armrest in time and maintain a stable state, the motion coefficient interval for solving the function expression 1-1 is increased, that is, calculation formula 1-2, that is, the motion coefficient interval is determined according to the movement speed range of the cart and the effective range of the force detection device. This allows the operator to have a better sense of control when controlling the movement of the chassis 57, and the movement of the chassis 57 has good follow-up performance in both high and low speed scenarios.

[0095] The function expression for calculating the motion coefficient interval is 1-2:

[0096]

[0097] In the above formula 1-2, Fmin and Fmax are the minimum and maximum values ​​of the effective range of the force detection device, Vmin and Vmax are the minimum and maximum values ​​of the cart movement speed range, Vmin and Vmax are known quantities that have been set for the cart, and Kmin and Kmax are the minimum motion coefficient threshold and maximum motion coefficient threshold of the motion coefficient interval.

[0098] Formula 1-2 determines the motion coefficient interval according to the motion speed range of the cart and the effective range of the force detection device. The motion coefficient in the straight / rotational dimension is compared with the motion coefficient interval, and the motion coefficient interval is defined by the minimum motion coefficient threshold and the maximum motion coefficient threshold. If the motion coefficient in the straight / rotational dimension is not within the motion coefficient interval, it is modified to the one with the smaller difference between the two thresholds defining the motion coefficient interval. For example, if the motion coefficient in the straight / rotational dimension is less than the minimum motion coefficient threshold, the motion coefficient in the straight / rotational dimension is modified to the minimum motion coefficient threshold; if the motion coefficient in the straight / rotational dimension is greater than the maximum motion coefficient threshold, the motion coefficient in the straight / rotational dimension is modified to the maximum motion coefficient threshold.

[0099] If the function expression 1-2 is missing as a prerequisite constraint, the speed switching process of the multiple moving wheels 59 will become unstable and step jumps will occur. The threshold of the motion coefficient interval can be calculated by other methods, such as using Vmin and Fmin to calculate Kmax. Other parameters can also be used to calculate the threshold of the motion coefficient interval, such as the rated range of the output force / torque of the motor driving the moving wheel.

[0100] In step S100, the motion coefficients of the cart in the straight dimension and the rotation dimension and the motion mode of the cart are determined according to the external force collected by the force detection device, and the motion mode is also determined according to the comparison result of the first threshold and the first component and the comparison result of the second threshold and the second component.

[0101] Specifically, the coordinate system X of the force detection device 52 F Y F The base 57 is parallel to the lateral mounting surface of the fixing plate 51, and the coordinate system X0Y0 of the chassis 57 is parallel to the horizontal ground. Through the coordinate system conversion, the coordinate system X0Y0 of the force detection device 52 is converted to F Y F The external force under the chassis 57 is converted into the estimated amount and direction of motion under the coordinate system X0Y0 of the chassis 57, so that the operator can use the coordinate system X0Y0Z0 of the chassis 57 as a reference to determine the movement mode of the cart and control the size of the external force.

[0102] The motion mode of the cart depends on the components of the external force in each quadrant of the chassis coordinate system X0Y0. Specifically, the motion mode of the cart includes stationary, straight or rotating, such as straight forward and backward, left and right rotation in place, rotation while moving in the left front, rotation while moving in the right front, rotation while moving in the left rear, rotation while moving in the right rear, or lateral movement. The external force can be converted into motion quantities such as the speed or acceleration of the drive motor by constructing one or more algorithm model equations or looking up tables.

[0103] like Figure 6As shown, the chassis coordinate system X0Y0 is divided into four-quadrant orientation coordinate diagrams. In essence, there are no four quadrants. The positive and negative of the first component Fy and the second component Fx represent their directions. The four quadrants are used to illustrate how to determine the direction of the cart's straight and rotation according to the positive and negative / direction of the first component and the second component. The width range of each quadrant of the four-quadrant orientation coordinate diagram is 90°, and the four quadrants correspond to a 360° range centered on the surgical robot. In this embodiment, the four-quadrant orientation coordinate diagram is a two-dimensional coordinate diagram of the chassis 57 coordinate system X0Y0 along the Z0 axis perpendicular to the ground, with the positive direction of the O0Y0 axis as the forward direction and the positive direction of the O0X0 axis as the right direction, presenting different motion modes of the cart, that is, the motion mode of the cart. The different motion modes of the cart include: forward and backward straight along the Y0 axis, left rotation or right rotation in place with O0 as the rotation center, rotation while moving in the right front in the first quadrant, rotation while moving in the left front in the second quadrant, rotation while moving in the left rear in the third quadrant, and rotation while moving in the right rear in the fourth quadrant. The motion modes of the cart can be achieved by controlling with one hand or the left hand, or with both hands at the same time. The operator can use both hands or one hand to control according to the usage habits to achieve the same control effect.

[0104] The motion coefficient in the straight dimension is determined according to the first component, the motion coefficient in the rotation dimension is determined according to the second component, and the motion mode of the cart is determined according to the comparison result between the first threshold and the first component and the comparison result between the second threshold and the second component. The motion mode of the cart is determined according to the comparison result between the first threshold and the first component and the comparison result between the second threshold and the second component. For example, the specific process is as follows:

[0105] The external force is converted from the coordinate system of the force detection device to the chassis coordinate system. The components of the external force in each quadrant of the chassis coordinate system X0Y0 include a first component Fy and a second component Fx, such as Figure 7 As shown, the first threshold Fy is established th With the second threshold Fx th Used to determine the motion mode of the cart, the first threshold Fy th and the second threshold Fx th is the minimum force value measured by the force detection device 52 that can drive the cart to move. Figure 7 The force action areas are divided by taking the first quadrant of as an example, and the force action areas specifically include the first area, the second area, the third area, and the fourth area, which correspond to different motion modes of the cart. Among them, the first area corresponds to the stop of the cart, the second area corresponds to the forward movement of the cart along the Y0 axis, the third area corresponds to the left rotation of the cart in situ with O0 as the rotation center, and the fourth area corresponds to the rotation of the left front of the chassis 57 during movement.

[0106] The motion mode of the cart is determined according to the comparison result between the first threshold and the first component and the comparison result between the second threshold and the second component. Figure 7 and Fig. 9 ,like Fig. 9 The flow chart of the force action area division model is shown as follows. th The comparison result with the first component Fy and the second threshold Fx th The comparison result with the second component Fx determines the motion mode including:

[0107] The modulus of the first component Fy and the first threshold Fy th Compare and compare the modulus of the second component Fx with the second threshold Fx th Compare:

[0108] M1211, if the modulus of the first component is less than the first threshold and the modulus of the second component is less than the second threshold, that is, when Fy <Fy th And Fx <Fx th When , the motion mode of the cart is static;

[0109] M1213. If the modulus of the first component is greater than or equal to the first threshold and the modulus of the second component is less than the second threshold, that is, when Fy≥Fy th And Fx≤Fx th When , the movement mode of the cart is straight;

[0110] M1215. If the modulus of the first component is less than the first threshold and the modulus of the second component is greater than or equal to the second threshold, that is, when Fy<Fy th And Fx>Fx th When , the movement mode is rotation in place;

[0111] M1217. If the modulus of the first component is greater than or equal to the first threshold and the modulus of the second component is greater than or equal to the second threshold, that is, Fy>Fy th And Fx>Fx th , the movement mode is rotation while moving.

[0112] Determining the motion estimation of each driving wheel based on external force, motion coefficient and motion mode includes:

[0113] If the cart's motion mode is stationary, the estimated motion of each driving wheel is 0, and the calculation formula is 1-3:

[0114] DelMotionRwheel=DelMotionLwheel=0#1-3

[0115] If the cart's motion mode is straight, the motion estimation of each driving wheel is the first motion estimation value K yf(Fy), the first motion estimation value is calculated based on the first component Fy and the motion coefficient Ky in the straight dimension. The calculation formula of the first motion estimation value is 1-4:

[0116] DelMotionRwheel=DelMotionLwheel=K y f(Fy)#1-4

[0117] If the motion mode of the cart is rotation in place, the motion estimation of each driving wheel is determined based on the second motion estimation value, which is calculated based on the second component Fx and the motion coefficient Kx in the rotation dimension. The second motion estimation value calculation formula is 1-5:

[0118] DelMotionLwheel=a*K x f(Fx),DelMotionRwheel=b*K x f(Fx)#1-5

[0119] In formula 1-5, a and b are weights, one of a and b is positive and the other is negative. The specific positive and negative is determined by whether it is a left turn or a right turn when Fx is positive. Specifically, if Fx is positive and it is a left turn, a is negative and b is positive; conversely, if Fx is positive and it is a right turn, a is positive and b is negative. The ratio of a and b determines which part is used as the axis for rotation. For example, when a+b=0, it rotates around the center of the line connecting a pair of driving wheels. For example, if the motion mode of the cart is to rotate left on the spot, the second motion estimate is:

[0120] -DelMotionLwheel=DelMotionRwheel=K x f(Fx)#1-6

[0121] If the motion mode of the cart is rotation while moving, the motion estimation of each driving wheel is the weighted sum of the first motion estimation value and the second motion estimation value, and the calculation formula is 1-7:

[0122]

[0123] In formula 1-7, a r 、a l 、b r and b l is the weight, the weights of the first motion estimation values ​​of all wheels are greater than 0 and are generally equal, and at least one of the weights of the second motion estimation values ​​is not 0. Optionally, the weights of the first motion estimation values ​​of all wheels are 1, and a r and a lThe absolute value of the difference is set to a fixed value, such as 1. When Fx is positive, whether it rotates left or right during travel determines a r and a l Specifically, if Fx is in the positive direction and the vehicle is turning left, then a r >a l ; On the contrary, if Fx is rotating right while moving, then a r l . For example, Figure 8 As shown, if the motion mode of the cart is left rotation during travel, the second motion estimation value is:

[0124]

[0125] In the above formula:

[0126] DelMotionRwheel is the estimated value of the right wheel motion;

[0127] DelMotionLwheel is the estimated value of left wheel motion;

[0128] K y is the coefficient of motion of the cart in the straight dimension;

[0129] K x is the coefficient of motion of the cart in the rotational dimension;

[0130] f(Fx) and f(Fy) represent a mathematical function model of Fx and Fy, which function model can be a polynomial function, or an exponential function, a sine or cosine function, or a combination function, and can also be a kinematic model established for the cart.

[0131] After the motion estimation is determined, the motion estimation is converted into a motor motion instruction, and the motor motion instruction is output to the motor, thereby driving the rotation of the driving wheels among the multiple moving wheels to control the movement of the cart. Alternatively, a motion planning and calibration mathematical model of the chassis is established, and the motion estimation value is used as an input for calibration.

[0132] ​Since the external force collected by the force detection device 52 has components in each axis under the chassis coordinate system X0Y0, and changes in real time with the external force applied to the armrest by the operator. In order to make the chassis 57 move in the direction of the resultant force of the operator's hand, a motion planning and calibration mathematical model is established for the chassis 57. The motion planning and calibration mathematical model can be a closed-loop control algorithm model or other algorithm models with equivalent functions. The calibration process is to calculate the error between the motion estimation value and the actual motion amount, and eliminate the error. Based on the motion estimation output in step S110, the chassis 57 is motion-planned. The output motion estimation includes jerk (differential of acceleration), acceleration, velocity, displacement and current, so as to ensure data continuity and the characteristics that the current motion estimation and the actual motion physical quantity of the motor are consistent and follow each other.

[0133] Furthermore, Fig.10 This is a control flow chart of motion planning and calibration of step S130.

[0134] The first process S1301: taking the motion estimation quantity outputted in step S130 as the first input quantity Xi.

[0135] Second process S1302: There is a second process 1302 that transmits the deviation to the first processing algorithm 1003. The first processing algorithm 1003 is a motion planning and calibration algorithm of the motion planning and calibration 130 process, which is not limited to an integration algorithm with convergence characteristics.

[0136] The third process S1303: The calibrated motion estimate is the first output quantity Xo. The calibrated motion estimate is converted into a motor motion instruction through the third process S1303. The driving device 1008 receives the motor motion instruction to drive the driving wheels among the multiple moving wheels 59. The driving device 1008 is the driving device D1\D2 of the embodiment of the present application.

[0137] Fourth process S1304: The first feedback quantity Xd is the data transmitted by the fourth process 1304. The first feedback quantity Xd is the data such as the speed, position, acceleration or current of the plurality of moving wheels 59 collected by the driving device 1008, or is the first output quantity Xo. There may be one or more second processing algorithms 1002 that convert the first feedback quantity Xd into the second feedback quantity Td by processing. The second processing algorithm 1002 is a feedback conversion model that performs data conversion or optimization on the first feedback quantity Xd and outputs it as the second feedback quantity Td.

[0138] The fifth process S1305: S1305 is a process of using the second feedback amount Td as a negative feedback amount, and the deviation amount transmitted by the second process 1302 is the error value between the first input amount Xi and the second feedback amount Td. This model is not limited to being expanded and reduced or optimized as a dynamic model algorithm based on the above-mentioned process.

[0139] Step S140: converting the calibrated motion estimation into a motor motion instruction, and outputting the motor motion instruction to the motor. The driving device of the motor receives the motion instruction, thereby driving the rotation of the driving wheels in the plurality of moving wheels 59 to control the movement of the cart.

[0140] The present application also discloses a cart, comprising: a force detection device 52, a force-bearing mechanism, a motion execution mechanism and a processor, the motion execution mechanism comprising a chassis 57 and a plurality of moving wheels 59, some or all of the plurality of moving wheels 59 being drive wheels driven by a motor, the force detection device 52 being used to collect external forces applied to the force-bearing mechanism, and the processor being used to perform the following steps: determining the motion coefficients in the straight dimension and the rotational dimension of the cart and the motion mode of the cart according to the external forces collected by the force detection device 52; determining the motion estimation of each drive wheel according to the external force, the motion coefficient and the motion mode; converting the motion estimation into a motor motion instruction, and outputting the motor motion instruction to the motor drive to drive the rotation of the wheel to control the movement of the cart.

[0141] In the above-mentioned process of controlling the movement of the cart, the force detection device 52 is easily overloaded or impacted, causing the force sensor to be plastically deformed or even damaged, due to the current normal use of the surgical robot cart, such as leaning against the armrest, manual transfer when the battery is low, and bumps during transportation. The damage cannot be repaired on site and can only be replaced with parts, causing the product to be unable to be used normally. In view of the problem that the force detection device 52 is easily overloaded or impacted, causing the force detection device 52 to be plastically deformed or even damaged. Therefore, the present application also provides a force detection device 52 of a cart with an over-range protection structure.

[0142] Force detection device 52 Example 1:

[0143] See also Figure 11A-11C The present application provides a force detection device 52 for a cart, and the force detection device 52 includes: a force-bearing mechanism 7 configured to receive external force, a force transmission mechanism 8 fixed on the force-bearing mechanism 7, a limiting mechanism 9 fixedly connected to the force-bearing mechanism 7, and a force detection mechanism 10 fixed on the limiting mechanism 9.

[0144] Specifically, the force-bearing mechanism 7 includes a left handrail 60 and a right handrail 54. When the force-bearing mechanism 7 is used to receive external force, it is transmitted to the force transmission mechanism 8, the limit mechanism 9 and the force detection mechanism 10. In the Cartesian coordinate system, an object, such as the robot field to which the present application belongs, is subjected to external forces on the force-bearing mechanism 7 with at most six degrees of freedom, namely: force Fx along the X-axis translation direction, torque Mx around the X-axis, force Fy along the Y-axis translation direction, torque My around the Y-axis, force Fz along the Z-axis translation direction, and torque Mz around the Z-axis.

[0145] The limiting mechanism 9 includes a fixed seat 1 and a sliding assembly 100. The fixed seat 1 is configured to fix the force detection mechanism 10, and the sliding assembly 100 is fixed on the fixed seat 1. The function of the sliding assembly 100 is that when an external force is applied to the force receiving mechanism 7, there are external forces of six degrees of freedom on the force receiving mechanism 7, and the force receiving mechanism 7 transmits the external force Fx in the direction of the first degree of freedom and the external force Fy in the direction of the second degree of freedom to the force transmission mechanism 8, while the external forces in the directions of other degrees of freedom are transmitted to the fixed seat 1 through the sliding assembly 100, so that the external forces in the directions of other degrees of freedom cannot be transmitted to the force detection mechanism 10.

[0146] Specifically, the sliding assembly 100 includes a slide rail member 101 fixed on the fixed seat 1 and a slide member 102 that can move relatively along the slide rail member 101. The slide member 102 is configured to move along the slide rail member 101 in the first degree of freedom direction or in the second degree of freedom direction, and the first degree of freedom direction and the second degree of freedom direction are located in different dimensional directions. In this embodiment, the first degree of freedom direction is the translation direction along the X-axis centered on the fixed seat 1, and the second degree of freedom direction is the translation direction along the Y-axis centered on the fixed seat 1, and the first degree of freedom direction is perpendicular to the second degree of freedom direction. The slide member 102 is also configured to remain stationary relative to the slide rail member 101 when receiving external forces in other degrees of freedom directions on the force-bearing mechanism 7, and transmit external forces in other degrees of freedom directions to the fixed seat 1, without transmitting external forces in other degrees of freedom directions to the force detection mechanism 10.

[0147] The force transmission mechanism 8 includes a force transmission seat 6 fixedly connected to the force receiving mechanism 7, a force unloading hole 62 provided on the force transmission seat 6, and a force unloading portion 11 fixed on the fixed seat 1. The force unloading portion 11 is provided in the force unloading hole 62, and a first gap is provided between the force unloading portion 11 and the force unloading hole 62. Fig. 11C As shown, the fixed seat 1 includes a force sensing base 23, the force sensing base 23 is fixedly connected to the fixed seat 1, and the unloading part 11 is fixed on the force sensing base 23. The force transmission mechanism 8 is configured to transmit the external force on the force receiving mechanism 7 along the first degree of freedom direction or the second degree of freedom direction to the force detection mechanism 10, so that the force detection mechanism 10 detects the external force Fx in the first degree of freedom direction or the external force Fy in the second degree of freedom direction. The unloading part 11 is configured to transmit the overloaded external force on the force receiving mechanism 7 along the first degree of freedom direction and the second degree of freedom direction to the fixed seat 1 when it contacts the unloading hole 62. The shape of the unloading part 11 is not limited, and the unloading part 11 can be a cylindrical, square column or conical column. For example, in other embodiments, the unloading part 11 is configured as a conical column, and the unloading hole 62 is configured as a conical hole, then the first gap is configured as an adjustment device (not shown in the figure), and the first gap between the conical column and the conical hole can be adjusted by adjusting the relative height between the conical column and the conical hole.

[0148] Specifically, the first gap between the unloading portion 11 and the unloading hole 62 is a gap that ensures that the force detection unit 2 will not be overloaded. It is determined based on the overload range of the force detection unit 2. Generally, the force detection unit 2 itself has a certain overload range, which is a parameter of the force detection unit 2 itself. The overload range is a certain multiple of the standard range, such as 2-3 times. If the external force load continues to increase beyond this multiple, the force detection unit 2 will continue to deform until it is damaged.

[0149] The force detection mechanism 10 includes: a force detection unit 2 fixed to a fixed seat 1, and a force transmission column 21 fixedly connected to the force detection unit 2, and a force transmission hole 61 provided on the force transmission seat 6. The force transmission column 21 is provided in the force transmission hole 61, and a second gap is provided between the force transmission column 21 and the force transmission hole 61. When the force transmission column 21 is configured to contact the force transmission hole 61, the external force Fx along the first degree of freedom direction or the external force Fy along the second degree of freedom direction on the force-bearing mechanism 7 is transmitted to the force detection unit 2. The second gap provided between the force transmission column 21 and the force transmission hole 61 is used to allow the force detection unit 2 to deform freely and normally during operation, and the normal deformation amount of the force detection unit 2 is 0.1-0.2mm.

[0150] Furthermore, the first gap between the unloading part 11 and the unloading hole 62 is smaller than the second gap between the force transmission column 21 and the force transmission hole 61, and the second gap is larger than the normal deformation of the force detection unit 2, so that when the external force is continuously applied to the force-bearing mechanism 7, before the force transmission column 21 contacts the force transmission hole 61, the unloading hole 62 will first contact the unloading part 11, thereby transmitting the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force-bearing mechanism 7 to the fixing seat 1, so that the deformation of the force detection unit 2 is within the normal working range. For example, in this embodiment, the first gap between the unloading part 11 and the unloading hole 62 is 0.3mm, and the second gap between the force transmission hole 61 and the force transmission column 21 is 0.2-0.5mm. The first gap and the second gap are used to prevent the force detection unit 2 from exceeding the normal deformation and being damaged.

[0151] like Fig. 11C As shown, the inner side of the force transmission hole 61 on the force transmission seat 6 is provided with a plurality of elastic elements 63, and the elastic elements 63 are in contact with the side of the force transmission column 21. The elastic elements include materials such as springs, rubber, and latex. When the elastic elements 63 are configured to contact the force transmission column 21, the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force receiving mechanism 7 is transmitted to the force transmission column 21.

[0152] The slide rail member 101 further includes a transverse slide rail 31 in the first degree of freedom direction and a longitudinal slide rail 41 in the second degree of freedom direction, wherein the transverse slide rail 31 is perpendicular to the longitudinal slide rail 41. The slide member 102 relatively moving along the slide rail member 101 further includes a transverse slide block 32 and a longitudinal slide block 42, wherein the transverse slide block 32 is configured to move on the transverse slide rail 31, and the longitudinal slide block 42 is configured to move on the longitudinal slide rail 41. The slide assembly 100 further includes a slide plate 103, which is fixed to the upper end surface of the slide member 102, and further includes a transverse slide plate 33 and a longitudinal slide plate 43. In this embodiment, the transverse slide rail 31 is fixed on the mounting groove 12 of the fixed seat 1, the transverse sliding block 32 on the transverse slide rail 31 is fixedly connected to the lower end surface of the transverse slide plate 33, the upper end surface of the transverse slide plate 33 is fixedly connected to the longitudinal slide rail 41, the upper end surface of the longitudinal sliding block 42 on the longitudinal slide rail 41 is fixedly connected to the lower end surface of the longitudinal slide plate 43, the upper end surface 431 of the longitudinal slide plate 43 is fixedly connected to the lower end surface 52 of the force-bearing mechanism 7, and the front end surface 51 of the force-bearing mechanism 7 is fixedly connected to the rear end surface 65 of the force transmission seat 6.

[0153] Furthermore, the method of protecting the force detection unit 2 is as follows: when the force-bearing mechanism 7 is subjected to external force, the force transmission hole 61 transmits the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism 7 to the force detection unit 2 through the force transmission column 21. When the external force is too large and causes the force detection unit 2 to deform too much, the force unloading hole 62 will first contact the force unloading part 11, thereby transmitting the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force-bearing mechanism 7 to the fixed seat 1. External forces in other degrees of freedom directions are transmitted to the fixed seat 1 through the sliding assembly 100, so that the force detection unit 2 is within the normal working range, and the over-range protection of the force detection unit 2 is realized.

[0154] Force detection device 52 embodiment 2:

[0155] In another embodiment, see Figures 12A-12C The present application provides a force detection device 52 for a cart, and the force detection device 52 includes: a force-bearing mechanism 7 configured to receive external force, a force transmission mechanism 8' fixed on the force-bearing mechanism 7, a limiting mechanism 9' fixedly connected to the force-bearing mechanism 7, and a force detection mechanism 10' fixed on the limiting mechanism 9'.

[0156] Specifically, the force-bearing mechanism 7 includes a left handrail 60 and a right handrail 54. The force-bearing mechanism 7 is used to transmit the external force to the force transmission mechanism 8', the limit mechanism 9' and the force detection mechanism 10' after receiving the external force. In the Cartesian coordinate system, an object, such as the robot field to which the present application belongs, is subjected to external forces on the force-bearing mechanism 7 with a maximum of six degrees of freedom, namely: force Fx along the X-axis translation direction, torque Mx around the X-axis, force Fy along the Y-axis translation direction, torque My around the Y-axis, force Fz along the Z-axis translation direction, and torque Mz around the Z-axis.

[0157] like Fig. 12B As shown, the limiting mechanism 9' comprises a fixed seat 1 and a sliding assembly 100. The fixed seat 1 is configured to fix the force detection mechanism 10', and the sliding assembly 100 is fixed on the fixed seat 1. The function of the sliding assembly 100 is that when an external force is applied to the force-bearing mechanism 7, there are external forces of six degrees of freedom on the force-bearing mechanism 7, and the force-bearing mechanism 7 transmits the external force Fx in the direction of the first degree of freedom and the external force Fy in the direction of the second degree of freedom to the force transmission mechanism 8', while the external forces in the directions of other degrees of freedom are transmitted to the fixed seat 1 through the sliding assembly 100, so that the external forces in the directions of other degrees of freedom cannot be transmitted to the force detection mechanism 10'.

[0158] Specifically, the sliding assembly 100 includes a slide rail member 101 fixed on the fixed seat 1, and a slide member 102 that can move relatively along the slide rail member 101, and the slide member 102 is configured to move along the slide rail member 101 in the first degree of freedom direction or in the second degree of freedom direction, and the first degree of freedom direction and the second degree of freedom direction are located in different dimensional directions. In this embodiment, the first degree of freedom direction is the translation direction along the X-axis centered on the fixed seat 1, and the second degree of freedom direction is the translation direction along the Y-axis centered on the fixed seat 1, and the first degree of freedom direction is perpendicular to the second degree of freedom direction. The slide member 102 is also configured to remain stationary relative to the slide rail member 101 when receiving external forces in other degrees of freedom directions on the force-bearing mechanism 7, and transmit external forces in other degrees of freedom directions to the fixed seat 1, without transmitting external forces in other degrees of freedom directions to the force detection mechanism 10'.

[0159] The force transmission mechanism 8' comprises a force transmission seat 6' and a limit block 13 fixedly connected to the force receiving mechanism 7. The limit block 13 is fixed on the fixed seat 1, and the limit block 13 is configured to transmit the external force of the force receiving mechanism 7 along the first degree of freedom direction and the second degree of freedom direction to the fixed seat 1 when in contact with the force transmission seat 6'.

[0160] The force transmission seat 6 ′ includes a force transmission module 64 and a connection module 65 , which are fixedly connected. The force transmission module 64 is arranged in the space of the limit block 13 , and a third gap is arranged between the force transmission module 64 and the limit block 13 .

[0161] The force detection mechanism 10' comprises: a force detection unit 2 fixed to a force sensing base 23, a force transmission column 21' fixedly connected to the force detection unit 2, and a force transmission hole 61' provided on a force transmission base 6'. Fig. 12C As shown, the front end face of the fixed seat 1 is fixedly connected to the fixed plate 51, and the rear end face of the fixed seat 1 includes a force sensing base 23, the force sensing base 23 is fixedly connected to the fixed seat 1, the force detection unit 2 is fixed on the force sensing base 23 by screws or bolts 22, and the upper end face of the force detection unit 2 is fixedly connected to the force transmission column 21'. Among them, the force transmission column 21' is arranged in the force transmission hole 61', and there is a second gap between the force transmission column 21' and the force transmission hole 61'. When the force transmission column 21' is configured to contact the force transmission hole 61', the external force Fx along the first degree of freedom direction or the external force Fy along the second degree of freedom direction on the force-bearing mechanism 7 is transmitted to the force detection unit 2. The second gap set between the force transmission hole 61' and the force transmission column 21' has the function of allowing the force detection unit 2 to deform freely and normally during operation, and the deformation amount of the normal deformation of the force detection unit 2 is 0.1-0.2mm.

[0162] Furthermore, a third gap is provided between the limit block 13 and the force transmission seat 6 ′, and the third gap is set according to the over-range parameter of the force detection unit 2 , or is set by adjusting the limit block 13 .

[0163] When the left armrest 60 and the right armrest 54 are subjected to external force, the force transmission hole 61' transmits the external force Fx along the first degree of freedom direction or the external force Fy along the second degree of freedom direction from the force-bearing mechanism 7 to the force detection unit 2. When the external force is too large, resulting in excessive deformation of the force detection unit 2 in the first degree of freedom direction and the second degree of freedom direction, the third gap between the force transmission module 64 in the force transmission seat 6' and the limit block 13 becomes smaller and smaller until the force transmission module 64 contacts the limit block 13, thereby transmitting the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force-bearing mechanism 7 to the fixed seat 1, so that the deformation of the force detection unit 2 is within the normal working range, thereby achieving over-range protection of the force detection unit 2.

[0164] Among them, the third gap is set according to the overload range of the force detection unit 2, and the overload range is a certain multiple of the standard range of the force detection unit 2, such as 2-3 times. If the load continues to increase beyond this multiple, the force detection unit 2 will continue to deform until it is damaged; or the third gap can be adjusted by adjusting the limit block 13 according to the different standard ranges of the force detection unit 2 itself, and the limit block 13 can be applied to force detection units 2 of different ranges.

[0165] The third gap of the limit block 13 includes a gap in the X-direction, a gap in the X+direction, a gap in the Y+direction, and a gap in the Y-direction. Fig.13A As shown, the method and steps for adjusting the third gap by adjusting the limit block 13 are as follows:

[0166] In the initial state: screws 14, 15, 16, 17, 18 and 19 are not locked, and the gaps X+, X-, Y+ and Y- are large enough. Power is supplied to the force detection unit 2, and the external force data of the force detection unit 2 is read;

[0167] Adjust the gap boundaries in the X-direction, such as Fig. 13B As shown, Fig. 13B for Fig.13A Top view: screw in screw 16, the screw pushes against the right side of the force transmission module 64 and moves to the left, thus applying force to the force sensor in the X-direction, and the gap X-will shrink, while monitoring the external force data of the force detection unit 2 in this direction. As the screw is suspended, the X-gap becomes smaller and smaller, and the external force data of the force detection unit 2 becomes larger and larger, until the external force data of the force detection unit 2 reaches the desired protection range, and stop screwing in the screw. Then screw in screw 14 from screw 14 until the head of screw 14 contacts the left side of the force transmission module 64, and use a nut or the like to fix the screw in depth of screw 14, which is the boundary of the protection limit gap in the X-direction;

[0168] Adjust the boundaries of the gap in the X+ direction, such as Fig. 13C As shown: unscrew the screw at screw 16, the force sensor reading returns to 0, screw in the screw at screw 15, and apply force to the force sensor in the X+ direction. In the same way, when the external force data reaches the desired protection range, screw in the screw at screw 16 until the screw head contacts the right side of the force transmission module 64. Use a nut to fix the screw-in depth of screw 16, which is the boundary of the protection limit gap in the Y+ direction.

[0169] The boundary of the gap in the Y+ direction, such as Fig.13D As shown: Similarly, the depth of the screw at position 17 is determined by using the screw at position 19, which is the boundary of the gap in the Y+ direction;

[0170] The boundary of the gap in the Y-direction, such as Fig.13D As shown: Similarly, use the screw at 18 to determine the depth of the screw at 19, which is the boundary of the gap in the Y-direction.

[0171] The required third gap between the limit block 13 and the force transmission seat 6' can be adjusted through the above steps, and the order of the above steps cannot be reversed. If reversed, the limit boundary in a certain direction may not be determined.

[0172] like Fig. 12CAs shown, the inner side of the force transmission hole 61' is provided with a plurality of elastic elements 63, and the elastic elements 63 are in contact with the side of the force transmission column 21'. The elastic elements include materials such as springs, rubber, and latex. When the elastic elements 63 are configured to contact the force transmission column 21', the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force receiving mechanism 7 is transmitted to the force transmission column 21'.

[0173] The slide rail member 101 further includes a transverse slide rail 31 in the first degree of freedom direction and a longitudinal slide rail 41 in the second degree of freedom direction, wherein the transverse slide rail 31 is perpendicular to the longitudinal slide rail 41. The slide member 102 relatively moving along the slide rail member 101 further includes a transverse sliding block 32 and a longitudinal sliding block 42, wherein the transverse sliding block 32 is configured to move on the transverse slide rail 31, and the longitudinal sliding block 42 is configured to move on the longitudinal slide rail 41. The sliding assembly 100 further includes a slide plate 33', which is fixed to the upper end surface of the transverse sliding block 32. In this embodiment, the transverse slide rail 31 is fixed on the mounting groove 12 of the fixed seat 1, the transverse sliding block 32 is fixedly connected to the lower end surface of the slide plate 33', the upper end surface of the slide plate 33' is fixedly connected to the longitudinal slide rail 41, the upper end surface of the longitudinal sliding block 42 on the longitudinal slide rail 41 is fixedly connected to the lower end surface of the force transmission seat 6', one end surface 651 of the force transmission seat 6' is fixedly connected to the front end surface 51 of the force receiving mechanism 7, and the other end surface 652 of the force transmission seat 6' is fixedly connected to the lower end surface 652 of the force receiving mechanism 7.

[0174] The structure of the transverse slide rail 31 of the present application being perpendicular to the longitudinal slide rail 41 has the following beneficial effects:

[0175] In the field of surgical robot carts applied in the present application, during normal operation, the left armrest 60 and the right armrest 54 need to sense the external force Fx in the direction of the first degree of freedom and the external force Fy in the direction of the second degree of freedom, but do not need to sense the third external force Fz. However, external forces in various directions may exist during actual operation. Since the height of the left armrest 60 and the right armrest 54 are near the waist of the operator, it is easier to habitually have a downward component when the external force is applied as a thrust. The structure of the transverse slide rail 31 perpendicular to the longitudinal slide rail 41 provided in the present application plays a supporting role, and the downward deformation of the force-bearing mechanism 7 is very small, such as within 0.3 mm, or even imperceptible, giving the operator an experience that the armrest is more reliable and more solid. For example, when a downward external force of 10Kg is applied to the force-bearing mechanism 7, and the transverse slide rail 31 of the present application is not set perpendicular to the longitudinal slide rail 41, the downward deformation of the force-bearing mechanism 7 is about 3-5mm, and the more obvious deformation or decline of the force-bearing mechanism 7 can be clearly felt. The overall experience of the force-bearing mechanism 7 is soft during operation; however, by setting the supporting transverse slide rail 31 perpendicular to the longitudinal slide rail 41 in the present application, the external force in multiple degrees of freedom directions of the present application is restricted, and the deformation in each degree of freedom direction of the force-bearing mechanism 7 is restricted, and the downward deformation of the force-bearing mechanism 7 is 0.1-0.3mm. Compared with the deformation of 3-5mm, the structure of the transverse slide rail 31 of the present application being perpendicular to the longitudinal slide rail 41 can significantly improve the overall rigidity performance of the force-bearing mechanism 7.

[0176] In this embodiment, the number of transverse and longitudinal rails is not limited, as long as the rigidity of the rails in each degree of freedom direction exceeds the rigidity of the force detection unit 2 and the rigidity of the handrail in user experience. In addition, the shape of the force detection unit 2 can also be cylindrical, square or octagonal.

[0177] The present application also provides a cart, which includes a force detection device 52, a fixed plate 51 and a motion actuator, the motion actuator includes a chassis 57 and a plurality of moving wheels 59, the lower end surface of the fixed plate 51 is fixedly connected to the chassis 57, and one side surface of the fixed plate 51 is connected to the fixed seat 1.

[0178] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0179] The above embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the present application. It should be pointed out that, for a person of ordinary skill in the art, several modifications and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the present application shall be subject to the attached claims.

Claims

1. A force detection device for a cart, characterized in that: The force detection device comprises a force receiving mechanism configured to receive external force, a force transmission mechanism fixed on the force receiving mechanism, a limiting mechanism fixedly connected to the force receiving mechanism, and a force detection mechanism fixed on the limiting mechanism, wherein the limiting mechanism comprises: A fixing seat, configured to fix the force detection mechanism; A sliding assembly, comprising a slide rail member fixed on the fixed seat and a sliding member relatively movable along the slide rail member, wherein the sliding member is configured to move along the slide rail member in a first degree of freedom direction or in a second degree of freedom direction, wherein the first degree of freedom direction and the second degree of freedom direction are located in different dimensional directions; The force transmission mechanism is configured to transmit the external force on the force receiving mechanism along the first degree of freedom direction or the second degree of freedom direction to the force detection mechanism, so that the force detection mechanism detects the external force in the first degree of freedom direction or the external force in the second degree of freedom direction; The sliding member is also configured to remain stationary relative to the slide rail member when receiving external forces in other degrees of freedom directions on the force-bearing mechanism, and transmit the external forces in other degrees of freedom directions to the fixed seat, without transmitting the external forces in other degrees of freedom directions to the force detection mechanism.

2. The force detection device according to claim 1, characterized in that: The force transmission mechanism also includes a force transmission seat fixedly connected to the force receiving mechanism, a force unloading hole provided on the force transmission seat, and a force unloading portion fixed on the fixed seat, wherein the force unloading portion is provided in the force unloading hole, and the force unloading portion is configured to transmit the overloaded external force along the first degree of freedom direction and the second degree of freedom direction on the force receiving mechanism to the fixed seat when in contact with the force unloading hole.

3. The force detection device according to claim 2, characterized in that: The force detection mechanism includes a force detection unit fixed to the fixed seat and a force transmission column fixedly connected to the force detection unit. The force transmission mechanism also includes a force transmission hole arranged on the force transmission seat. The force transmission column is arranged in the force transmission hole. When the force transmission column is configured to contact the force transmission hole, the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism is transmitted to the force detection unit.

4. The force detection device according to claim 3, characterized in that: A first gap is provided between the unloading portion and the unloading hole, a second gap is provided between the force transmission column and the force transmission hole, and the first gap is smaller than the second gap.

5. The force detection device according to claim 4, characterized in that: The second gap is larger than a normal deformation amount of the force detection unit.

6. The force detection device according to claim 3, characterized in that: An elastic element is arranged on the side of the force transmission hole, and when the elastic element is arranged to contact the force transmission column, the external force along the first degree of freedom direction or the external force along the second degree of freedom direction on the force-bearing mechanism is transmitted to the force transmission column.

7. The force detection device according to claim 1, characterized in that: The sliding assembly also includes a slide plate, which is fixed to the upper end surface of the sliding member. The slide rail member includes a transverse slide rail in the first degree of freedom direction and a longitudinal slide rail in the second degree of freedom direction. The transverse slide rail is perpendicular to the longitudinal slide rail.

8. The force detection device according to claim 7, characterized in that: The transverse slide rail is fixed on the mounting groove of the fixing seat, and the upper end surface of the slide plate on the sliding member is fixedly connected to the lower end surface of the force-bearing mechanism.

9. The force detection device according to claim 1, characterized in that: The front end surface of the force receiving mechanism is fixedly connected to the rear end surface of the force transmission seat.

10. The force detection device according to claim 1, characterized in that: The force transmission mechanism also includes a limit block, which is fixed on the fixed seat. When the limit block is configured to contact the force transmission seat, the overloaded external force along the first degree of freedom and the second degree of freedom on the force-bearing mechanism is transmitted to the fixed seat.

11. The force detection device according to claim 10, characterized in that: A third gap is provided between the limit block and the force transmission seat, and the third gap is set according to an over-range parameter of the force detection unit, or is set by adjusting the limit block.

12. A cart, characterized in that: The cart includes a force detection device, a fixed plate and a motion actuator as described in any one of claims 1 to 11, the motion actuator includes a chassis and a plurality of moving wheels, the lower end surface of the fixed plate is fixedly connected to the chassis, and one side surface of the fixed plate is connected to the fixed seat.