Method and device for measuring tension of driving rope of continuum robot
By constructing the mapping relationship between driving rope tension and motor current, an indirect estimation of driving rope tension of continuum robot is achieved, solving the structural complexity and volume increase problems caused by the introduction of force sensing equipment, and simplifying the robot design.
Patent Information
- Application Number
- CN202411217313.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-02
- Publication Date
- 2024-11-22
AI Technical Summary
The evaluation of drive rope tension in continuum robots usually relies on force sensing devices, resulting in complex structure and increased volume of the robot.
By obtaining the mapping relationship between the pre-constructed driving rope tension and the current of the drive motor, the target current is collected when the motor drives the continuum robot to move to a predetermined state, and the current driving rope tension is indirectly estimated based on the mapping relationship, avoiding the introduction of the force sensing device.
The robot structure is simplified, the volume is reduced, and an effective estimation of the tension of the continuous robot driving rope is achieved.
Smart Images

Figure CN118999872A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the technical field of intelligent robots, and more specifically, to a method and device for measuring the tension of a driving rope of a continuum robot. Background Art
[0002] Continuum robots are an emerging robotic technology, whose design is inspired by the softness and flexibility of living organisms. Compared with traditional rigid robots, continuum robots are made of soft materials, can freely change their shape and structure, and can be designed to be very small, which has broad application prospects in the medical field.
[0003] Continuum robots are usually driven by a drive rope. One end of the drive rope is fixed to the robot, and the other end is fixed to the motor shaft. The motor pulls the drive rope to control the movement of the robot. Usually, the evaluation of the tension of the drive rope needs to rely on force sensing equipment. However, the introduction of force sensing equipment will increase the volume of the robot body and complicate the robot structure. Summary of the invention
[0004] In view of this, the present disclosure provides a method and device for measuring the tension of a continuum robot drive rope, an electronic device, a storage medium, and a program product.
[0005] The present disclosure provides, on one hand, a method for measuring the tension of a driving rope of a continuum robot, comprising:
[0006] Acquire a pre-established mapping relationship between the tension of a driving rope and the current of a driving motor, wherein the continuum robot includes a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto;
[0007] When the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, collecting a target current of the current driving motor;
[0008] According to the above target current and the above mapping relationship, the current driving rope tension is obtained.
[0009] According to an embodiment of the present disclosure, when the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, collecting the target current of the current driving motor includes:
[0010] Within a first predetermined time range, continuously collecting the current driving the motor to obtain a plurality of first initial currents;
[0011] The average of the plurality of first initial currents is calculated to obtain the target current.
[0012] According to an embodiment of the present disclosure, the above mapping relationship is obtained according to the following operations:
[0013] In the case where the continuum robot comprises a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto, the force sensing device is connected to the driving ropes included in the continuum robot;
[0014] Driving the motor to rotate and gradually tightening the driving rope;
[0015] When the drive rope is in each predetermined tension state, the drive rope tension is sensed according to the force sensing device, and the current driving the motor is continuously collected within a second predetermined time range to obtain a plurality of second initial currents;
[0016] The mapping relationship is obtained according to the sensed drive rope tensions corresponding to the plurality of predetermined tensioning states and the plurality of second initial currents.
[0017] According to an embodiment of the present disclosure, the mapping relationship is obtained based on the sensed drive rope tensions corresponding to the plurality of predetermined tension states and the plurality of second initial currents, including:
[0018] For each predetermined tensioning state, calculating a current average of a plurality of second initial currents corresponding to the predetermined tensioning state;
[0019] Constructing a linear equation group related to the sensed drive rope tension and the current average value according to the sensed drive rope tension and the current average value corresponding to each of a plurality of predetermined tensioning states;
[0020] The above linear equations are solved using least squares to obtain the above mapping relationship.
[0021] According to an embodiment of the present disclosure, in each linear equation included in the above linear equation group, the above sensed drive rope tension and the above current mean value satisfy the relationship in the following formula (I):
[0022] (one)
[0023] in, Characterizes the sensed driving rope tension measured by the force sensing device when the driving rope is in the tensioned state i, represents the current mean value corresponding to the tension state i when the driving rope is in the tension state i, k represents the slope, and b represents the intercept.
[0024] According to an embodiment of the present disclosure, the mapping relationship is obtained based on the sensed drive rope tensions corresponding to the plurality of predetermined tension states and the plurality of second initial currents, including:
[0025] For each predetermined tensioning state, calculating a current mean and a standard deviation of a plurality of second initial currents corresponding to the predetermined tensioning state;
[0026] The mapping relationship is obtained according to the current mean value, the standard deviation and the target driving rope tension corresponding to each of a plurality of predetermined tensioning states.
[0027] According to an embodiment of the present disclosure, in the case where the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, before collecting the target current of the current driving motor, the method further includes:
[0028] Remove the force sensing device from the drive rope.
[0029] According to an embodiment of the present disclosure, the above-mentioned continuum robot further includes: a first continuum part and a second continuum part, wherein each of the above-mentioned first continuum part and the above-mentioned second continuum part is driven by a predetermined number of the above-mentioned driving ropes.
[0030] According to an embodiment of the present disclosure, each continuum portion includes a plurality of control rings, a plurality of connecting rods and a plurality of two-way joints, wherein the control rings are fixed on the connecting rods and have holes uniformly opened around them for the driving ropes to pass through, and the control rings are alternately connected with the two-way joints, and the two-way joints are used to realize the bending and deflection of each continuum when the predetermined number of driving ropes drive each continuum portion to move.
[0031] Another aspect of the present disclosure provides a continuum robot driving rope tension measurement device, comprising:
[0032] An acquisition module is used to acquire a pre-established mapping relationship between the tension of a driving rope and the current of a driving motor, wherein the continuum robot includes a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto;
[0033] A collection module, used for collecting a target current of the current driving motor when the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state;
[0034] The obtaining module is used to obtain the current driving rope tension according to the target current and the mapping relationship.
[0035] Another aspect of the present disclosure provides an electronic device, comprising:
[0036] one or more processors;
[0037] a memory for storing one or more programs,
[0038] When the one or more programs are executed by the one or more processors, the one or more processors implement the method as described above.
[0039] Another aspect of the present disclosure provides a computer-readable storage medium storing computer-executable instructions, which are used to implement the above method when executed.
[0040] Another aspect of the present disclosure provides a computer program product, the computer program product comprising computer executable instructions, and the instructions are used to implement the above method when executed.
[0041] According to the method for measuring the tension of the driving rope of a continuum robot provided by the embodiment of the present disclosure, by obtaining the mapping relationship between the pre-constructed driving rope tension and the current of the driving motor, the continuum robot includes multiple continua and multiple driving ropes corresponding to each continuum, each driving rope is driven by a motor corresponding to it, and when the driving rope in the continuum robot is driven by the motor to move, and then the continuum robot is controlled to move to a predetermined state, the target current of the current driving motor is collected, and the technical means for obtaining the current driving rope tension according to the target current and the mapping relationship can be used to obtain the current driving rope tension based on the target current and the mapping relationship without introducing a force sensing device in the continuum robot, thereby realizing an indirect estimation of the current driving rope tension of the continuum robot. Compared with a continuum robot that relies on a force sensing device to evaluate the driving rope tension, the structure of the robot is simplified and its volume is reduced. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] The above and other objects, features and advantages of the present disclosure will become more apparent through the following description of the embodiments of the present disclosure with reference to the accompanying drawings, in which:
[0043] Figure 1 An exemplary system architecture to which a method for measuring the tension of a continuum robot driven rope according to an embodiment of the present disclosure can be applied is schematically shown;
[0044] Figure 2 The flowchart of the method for measuring the tension of a continuum robot driving rope according to an embodiment of the present disclosure is schematically shown;
[0045] Figure 3 Schematically shows a schematic diagram of a continuum robot according to an embodiment of the present disclosure;
[0046] Figure 4 A schematic diagram schematically shows a cross-section of a control loop included in a continuum robot according to an embodiment of the present disclosure;
[0047] Figure 5A schematic diagram of a method for measuring the tension of a driving rope of a continuum robot according to an embodiment of the present disclosure, in which a force sensor is connected to a driving rope included in the continuum robot when a mapping relationship is constructed;
[0048] Figure 6 A block diagram schematically shows a continuum robot driving rope tension measurement device according to an embodiment of the present disclosure; and
[0049] Figure 7 The block diagram of an electronic device suitable for implementing a method for measuring the tension of a driving rope of a continuum robot according to an embodiment of the present disclosure is schematically shown. DETAILED DESCRIPTION
[0050] Hereinafter, embodiments of the present disclosure will be described with reference to the accompanying drawings. However, it should be understood that these descriptions are exemplary only and are not intended to limit the scope of the present disclosure. In the following detailed description, for ease of explanation, many specific details are set forth to provide a comprehensive understanding of the embodiments of the present disclosure. However, it is apparent that one or more embodiments may also be implemented without these specific details. In addition, in the following description, descriptions of known structures and technologies are omitted to avoid unnecessary confusion of the concepts of the present disclosure.
[0051] The terms used herein are only for describing specific embodiments and are not intended to limit the present disclosure. The terms "comprise", "include", etc. used herein indicate the existence of the features, steps, operations and / or components, but do not exclude the existence or addition of one or more other features, steps, operations or components.
[0052] All terms (including technical and scientific terms) used herein have the meanings commonly understood by those skilled in the art unless otherwise defined. It should be noted that the terms used herein should be interpreted as having a meaning consistent with the context of this specification and should not be interpreted in an idealized or overly rigid manner.
[0053] When using expressions such as "at least one of A, B, and C, etc.", they should generally be interpreted according to the meaning of the expression commonly understood by those skilled in the art (for example, "a system having at least one of A, B, and C" should include but is not limited to a system having A alone, B alone, C alone, A and B, A and C, B and C, and / or A, B, C, etc.).
[0054] In the related art, the tension of the driving rope is usually evaluated by force sensing equipment. However, the introduction of force sensing equipment will increase the volume of the robot body and complicate the robot structure. In order to at least partially solve the technical problems existing in the related art, the embodiments of the present disclosure provide a method and device for measuring the tension of the driving rope of a continuum robot, which can be applied to the field of intelligent robot technology.
[0055] An embodiment of the present disclosure provides a method for measuring the tension of a driving rope of a continuum robot, the method comprising: obtaining a pre-constructed mapping relationship between the driving rope tension and the current of a driving motor, wherein the continuum robot comprises a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto; while using a motor to drive the driving rope in the continuum robot to move and then controlling the continuum robot to move to a predetermined state, collecting a target current of the current driving motor; and obtaining the current driving rope tension according to the target current and the mapping relationship.
[0056] Figure 1 An exemplary system architecture to which a method for measuring the tension of a continuum robot-driven rope according to an embodiment of the present disclosure can be applied is schematically shown.
[0057] It should be noted that Figure 1 What is shown is merely an example of a system architecture to which the embodiments of the present disclosure can be applied, in order to help those skilled in the art understand the technical content of the present disclosure, but it does not mean that the embodiments of the present disclosure cannot be used in other devices, systems, environments or scenarios.
[0058] like Figure 1 As shown, the system architecture 100 according to this embodiment may include a first terminal device 101, a second terminal device 102, a third terminal device 103, a network 104, and a server 105. The network 104 is used to provide a medium for a communication link between the first terminal device 101, the second terminal device 102, the third terminal device 103, and the server 105. The network 104 may include various connection types, such as wired, wireless communication links, or optical fiber cables, etc.
[0059] The user can use the first terminal device 101, the second terminal device 102, and the third terminal device 103 to interact with the server 105 through the network 104 to receive or send messages, etc. Various communication client applications can be installed on the first terminal device 101, the second terminal device 102, and the third terminal device 103, such as shopping applications, web browser applications, search applications, instant messaging tools, email clients, social platform software, etc. (only for example).
[0060] The first terminal device 101, the second terminal device 102, and the third terminal device 103 may be various electronic devices having display screens and supporting web browsing, including but not limited to smart phones, tablet computers, laptop computers, desktop computers, and the like.
[0061] The server 105 may be a server that provides various services, such as a background management server (only as an example) that provides support for websites browsed by users using the first terminal device 101, the second terminal device 102, and the third terminal device 103. The background management server may analyze and process the received data such as user requests, and feed back the processing results (such as web pages, information, or data obtained or generated according to user requests) to the terminal device.
[0062] It should be noted that the method for measuring the tension of the drive rope of the continuum robot provided in the embodiment of the present disclosure can generally be executed by the server 105. Accordingly, the device for measuring the tension of the drive rope of the continuum robot provided in the embodiment of the present disclosure can generally be set in the server 105. The method for measuring the tension of the drive rope of the continuum robot provided in the embodiment of the present disclosure can also be executed by a server or a server cluster that is different from the server 105 and can communicate with the first terminal device 101, the second terminal device 102, the third terminal device 103 and / or the server 105. Accordingly, the device for measuring the tension of the drive rope of the continuum robot provided in the embodiment of the present disclosure can also be set in a server or a server cluster that is different from the server 105 and can communicate with the first terminal device 101, the second terminal device 102, the third terminal device 103 and / or the server 105.
[0063] It should be understood that Figure 1 The number of terminal devices, networks and servers in the embodiment is only for illustration. Any number of terminal devices, networks and servers may be provided according to implementation requirements.
[0064] The following will be based on Figure 1 The described scenario is described in detail. The method for measuring the tension of a continuum robot driving rope of the disclosed embodiment is described.
[0065] Figure 2 The flowchart of the method for measuring the tension of a continuum robot driving rope according to an embodiment of the present disclosure is schematically shown.
[0066] like Figure 2 As shown, the method includes operations S201 to S203.
[0067] In operation S201, a pre-built mapping relationship between a driving rope tension and a current of a driving motor is obtained, wherein the continuum robot includes a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto.
[0068] According to an embodiment of the present disclosure, the tension of the driving rope reflects the current state of the continuum robot. The current of the driving motor is obtained by detecting the current of the circuit where the driving motor is located when the continuum robot is driven to a predetermined state based on the tension of the driving rope.
[0069] According to an embodiment of the present disclosure, the continuum robot may be a flexible robot capable of bending and deflecting in multiple directions, and is usually driven by a drive rope. The continuum robot may be used to perform medical tasks such as endoscopic detection, polyp clipping, and lesion removal, so as to utilize its soft characteristics to perform precise and safe operations inside the human body.
[0070] In operation S202 , when a driving rope in a continuum robot is driven by a motor to move, thereby controlling the continuum robot to move to a predetermined state, a target current of a current driving motor is collected.
[0071] According to an embodiment of the present disclosure, when a drive rope in a continuum robot is driven by a motor to move and then the continuum robot is controlled to move to a predetermined state, a force sensing device is not included in the continuum robot when collecting a target current of the current drive motor.
[0072] In operation S203, the current driving rope tension is obtained according to the target current and the mapping relationship.
[0073] According to an embodiment of the present disclosure, the target current may be input into a mapping relationship, and the current driving rope tension may be obtained from the mapping relationship.
[0074] According to the method for measuring the tension of the driving rope of a continuum robot provided by the embodiment of the present disclosure, by obtaining the mapping relationship between the pre-constructed driving rope tension and the current of the driving motor, the continuum robot includes multiple continua and multiple driving ropes corresponding to each continuum, each driving rope is driven by a motor corresponding to it, and when the driving rope in the continuum robot is driven by the motor to move, and then the continuum robot is controlled to move to a predetermined state, the target current of the current driving motor is collected, and the technical means for obtaining the current driving rope tension according to the target current and the mapping relationship can be used to obtain the current driving rope tension based on the target current and the mapping relationship without introducing a force sensing device in the continuum robot, thereby realizing an indirect estimation of the current driving rope tension of the continuum robot. Compared with a continuum robot that relies on a force sensing device to evaluate the driving rope tension, the structure of the robot is simplified and its volume is reduced.
[0075] According to the embodiments of the present disclosure, Figure 2 The method for measuring the tension of the driving rope of a continuum robot is applied to Figure 3 In the continuum robot shown.
[0076] Figure 3 A schematic diagram of a continuum robot according to an embodiment of the present disclosure is schematically shown.
[0077] like Figure 3As shown, the continuum robot may include: a first continuum portion and a second continuum portion. Each of the first continuum portion and the second continuum portion is driven by a predetermined number of driving ropes.
[0078] Each continuum section may include a plurality of control rings, a plurality of connecting rods and a plurality of two-way joints. The control rings are fixed to the connecting rods and have holes uniformly opened around them for driving ropes to pass through. The control rings are alternately connected to the two-way joints, and the two-way joints are used to achieve the bending and deflection of each continuum when a predetermined number of driving ropes drive each continuum section to move.
[0079] For example, the predetermined number may be 3. Each continuum portion is driven by three drive ropes.
[0080] In addition, Figure 3 In the embodiment, the drive rope can be fixed to certain joint control rings (e.g. Figure 3 On the joint 1 control ring and the joint 2 control ring in the structure), the joint control ring ensures that the driving rope controls the continuum part.
[0081] Figure 3 The cross section of the control ring 301 in FIG. Figure 4 shown.
[0082] Figure 4 A schematic diagram schematically shows a cross-section of a control loop included in a continuum robot according to an embodiment of the present disclosure.
[0083] like Figure 4 As shown, the control ring is fixed on the connecting rod, and holes are evenly opened around it for the driving rope to pass through, which can ensure that the driving rope is always in close contact with the continuum part.
[0084] Figure 5 A schematic diagram of a method for measuring the tension of a driving rope of a continuum robot according to an embodiment of the present disclosure, in which a force sensor is connected to the driving rope included in the continuum robot when constructing a mapping relationship, is shown.
[0085] like Figure 5 As shown, when constructing the mapping relationship, a portion of the driving rope can be selected and cut, and the cut driving rope can be tied to the two ends of the force sensor. When the driving motor drags the driving rope, the force sensor can measure the change in tension on the driving rope.
[0086] According to an embodiment of the present disclosure, Figure 2 The mapping relationship included in operation S201 is obtained according to the following operations:
[0087] In the case where the continuum robot includes a plurality of continua and a plurality of drive ropes corresponding to each continuum, and each drive rope is driven by a motor corresponding thereto, the force sensing device is connected to the drive rope included in the continuum robot;
[0088] The driving motor rotates and gradually tightens the driving rope;
[0089] When the drive rope is in each predetermined tension state, the drive rope tension is sensed according to the force sensing device, and the current of the drive motor is continuously collected within a second predetermined time range to obtain a plurality of second initial currents;
[0090] A mapping relationship is obtained according to the sensed drive rope tensions corresponding to each of the plurality of predetermined tension states and the plurality of second initial currents.
[0091] According to an embodiment of the present disclosure, when acquiring the mapping relationship, a force sensing device is connected to a driving rope included in the continuum robot, so that the force sensing device can measure the tension of the driving rope under different tensioning degrees.
[0092] According to an embodiment of the present disclosure, a mapping relationship is obtained based on the sensed drive rope tension and multiple second initial currents corresponding to each of multiple predetermined tensioning states, so as to construct a mapping relationship between the drive rope tension and the drive motor current based on the current data of the drive motor when the drive rope of the continuum robot is in different tensioning states.
[0093] According to an embodiment of the present disclosure, according to the sensed drive rope tensions and the plurality of second initial currents corresponding to the plurality of predetermined tension states, the mapping relationship is obtained, including:
[0094] For each predetermined tension state, calculating a current average of a plurality of second initial currents corresponding to the predetermined tension state;
[0095] constructing a set of linear equations related to the sensed drive rope tension and the current mean value according to the sensed drive rope tension and the current mean value corresponding to each of the plurality of predetermined tensioning states;
[0096] The least square method is used to solve the linear equations and obtain the mapping relationship.
[0097] According to an embodiment of the present disclosure, since the current data of the driving motor has fluctuations, the current data (ie, multiple second initial currents) of the driving motor within the T time period (ie, within the second predetermined time range) are averaged. Replace real-time current data , current data mean Compared with real-time current data It can better reflect the actual current of the drive motor, and even according to the average value of current data The constructed mapping relationship will be more accurate.
[0098] According to an embodiment of the present disclosure, in each linear equation included in the linear equation group, the sensed driving rope tension and the current mean value satisfy the relationship in the following formula (I):
[0099] (one)
[0100] in, It represents the driving rope tension measured by the force sensing device when the driving rope is in the tensioned state i. represents the current mean value corresponding to the tension state i when the drive rope is in the tension state i, k represents the slope, and b represents the intercept.
[0101] According to the embodiment of the present disclosure, the linear equations are solved by least squares to obtain the value of k and the value of b in formula (I), and then obtain the mapping relationship. After the target current is obtained, the target current can be substituted into formula (I) to obtain the current driving rope tension.
[0102] According to an embodiment of the present disclosure, according to the sensed drive rope tensions and the plurality of second initial currents corresponding to the plurality of predetermined tension states, the mapping relationship is obtained, including:
[0103] For each predetermined tension state, calculating a current mean and a standard deviation of a plurality of second initial currents corresponding to the predetermined tension state;
[0104] A mapping relationship is obtained according to the current mean value, the standard deviation and the target driving rope tension corresponding to each of the plurality of predetermined tensioning states.
[0105] For example, for each predetermined tension state, the current mean and standard deviation corresponding to the predetermined tension state can be added and subtracted to obtain the current range corresponding to the predetermined tension state, and then the mapping relationship corresponding to the predetermined tension state can be obtained. After the target current is obtained later, the current range of the target current can be determined first, and then the current driving rope tension corresponding to the target current can be determined according to the current range. Since the current data of the driving motor is volatile, the current range data of the driving motor within the T time period (i.e., the second predetermined time range) is used instead of the real-time current data. , compared to real-time current data , the constructed mapping relationship is more accurate.
[0106] According to an embodiment of the present disclosure, Figure 2 In the method, when a driving rope in a continuum robot is driven by a motor to move, thereby controlling the continuum robot to move to a predetermined state, before collecting the target current of the current driving motor, it also includes: removing the force sensing device from the driving rope.
[0107] According to the embodiments of the present disclosure, Figure 2The operation S202 shown, in which the target current of the current driving motor is collected when the driving rope in the continuum robot is driven by the motor to move, thereby controlling the continuum robot to move to a predetermined state, may include the following operations:
[0108] Within a first predetermined time range, the current of the driving motor is continuously collected to obtain a plurality of first initial currents; and the average of the plurality of first initial currents is calculated to obtain the target current.
[0109] According to the embodiment of the present disclosure, both the first predetermined time range and the second predetermined time range can be selected according to actual conditions, and are not limited here. The first predetermined time range and the second predetermined time range can be the same or different.
[0110] Based on the above-mentioned method for measuring the tension of a continuum robot driving rope, an embodiment of the present disclosure further provides a device for measuring the tension of a continuum robot driving rope.
[0111] Figure 6 A block diagram of a continuum robot driving rope tension measurement device according to an embodiment of the present disclosure is schematically shown.
[0112] like Figure 6 As shown, the continuum robot driving rope tension measurement device 600 may include an acquisition module 610 , a collection module 620 and a obtaining module 630 .
[0113] The acquisition module 610 is used to acquire the pre-constructed mapping relationship between the tension of the driving rope and the current of the driving motor, wherein the continuum robot includes multiple continua and multiple driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding to it.
[0114] The acquisition module 620 is used to acquire the target current of the current driving motor when the driving rope in the continuum robot is driven by the motor to move, thereby controlling the continuum robot to move to a predetermined state.
[0115] The obtaining module 630 is used to obtain the current driving rope tension according to the target current and the mapping relationship.
[0116] It should be noted that the part about the method for measuring the tension of the continuum robot driving rope and the part about the device for measuring the tension of the continuum robot driving rope in the embodiment of the present disclosure correspond to each other. The description of the device for measuring the tension of the continuum robot driving rope refers to the part about the method for measuring the tension of the continuum robot driving rope, which will not be repeated here.
[0117] According to an embodiment of the present disclosure, any multiple of the acquisition module 610, the acquisition module 620, and the acquisition module 630 can be combined in one module / unit / sub-unit for implementation, or any one of the modules / units / sub-units can be split into multiple modules / units / sub-units. Alternatively, at least part of the functions of one or more of these modules / units / sub-units can be combined with at least part of the functions of other modules / units / sub-units and implemented in one module / unit / sub-unit. According to an embodiment of the present disclosure, at least one of the acquisition module 610, the acquisition module 620, and the acquisition module 630 can be at least partially implemented as a hardware circuit, such as a field programmable gate array (FPGA), a programmable logic array (PLA), a system on a chip, a system on a substrate, a system on a package, an application specific integrated circuit (ASIC), or can be implemented by hardware or firmware such as any other reasonable way of integrating or packaging the circuit, or implemented in any one of the three implementation methods of software, hardware, and firmware, or in any appropriate combination of any of them. Alternatively, at least one of the acquisition module 610 , the collection module 620 , and the obtaining module 630 may be at least partially implemented as a computer program module, and when the computer program module is executed, a corresponding function may be performed.
[0118] Figure 7 The block diagram of an electronic device suitable for implementing a method for measuring the tension of a driving rope of a continuum robot according to an embodiment of the present disclosure is schematically shown. Figure 7 The electronic device shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present disclosure.
[0119] like Figure 7 As shown, the electronic device 700 according to an embodiment of the present disclosure includes a processor 701, which can perform various appropriate actions and processes according to a program stored in a read-only memory (ROM) 702 or a program loaded from a storage part 708 to a random access memory (RAM) 703. The processor 701 may include, for example, a general-purpose microprocessor (such as a CPU), an instruction set processor and / or a related chipset and / or a special-purpose microprocessor (for example, an application-specific integrated circuit (ASIC)), etc. The processor 701 may also include an onboard memory for caching purposes. The processor 701 may include a single processing unit or multiple processing units for performing different actions of the method flow according to an embodiment of the present disclosure.
[0120] In RAM703, various programs and data required for the operation of electronic device 700 are stored. Processor 701, ROM702 and RAM 703 are connected to each other via bus 704. Processor 701 performs various operations of the method flow according to the embodiment of the present disclosure by executing the program in ROM 702 and / or RAM 703. It should be noted that the program can also be stored in one or more memories other than ROM 702 and RAM 703. Processor 701 can also perform various operations of the method flow according to the embodiment of the present disclosure by executing the program stored in the one or more memories.
[0121] According to an embodiment of the present disclosure, the electronic device 700 may further include an input / output (I / O) interface 705, which is also connected to the bus 704. The system 700 may further include one or more of the following components connected to the input / output (I / O) interface 705: an input portion 706 including a keyboard, a mouse, etc.; an output portion 707 including a cathode ray tube (CRT), a liquid crystal display (LCD), etc., and a speaker, etc.; a storage portion 708 including a hard disk, etc.; and a communication portion 709 including a network interface card such as a LAN card, a modem, etc. The communication portion 709 performs communication processing via a network such as the Internet. A drive 710 is also connected to the input / output (I / O) interface 705 as needed. A removable medium 711, such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, etc., is installed on the drive 710 as needed, so that a computer program read therefrom is installed into the storage portion 708 as needed.
[0122] According to an embodiment of the present disclosure, the method flow according to an embodiment of the present disclosure can be implemented as a computer software program. For example, an embodiment of the present disclosure includes a computer program product, which includes a computer program carried on a computer-readable storage medium, and the computer program contains a program code for executing the method shown in the flowchart. In such an embodiment, the computer program can be downloaded and installed from the network through the communication part 709, and / or installed from the removable medium 711. When the computer program is executed by the processor 701, the above-mentioned functions defined in the system of the embodiment of the present disclosure are executed. According to an embodiment of the present disclosure, the system, equipment, device, module, unit, etc. described above can be implemented by a computer program module.
[0123] The present disclosure also provides a computer-readable storage medium, which may be included in the device / apparatus / system described in the above embodiments; or may exist independently without being assembled into the device / apparatus / system. The above computer-readable storage medium carries one or more programs, and when the above one or more programs are executed, the method according to the embodiment of the present disclosure is implemented.
[0124] According to an embodiment of the present disclosure, the computer-readable storage medium may be a non-volatile computer-readable storage medium. For example, it may include, but is not limited to: a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination thereof. In the present disclosure, a computer-readable storage medium may be any tangible medium containing or storing a program that may be used by or in combination with an instruction execution system, apparatus, or device.
[0125] For example, according to an embodiment of the present disclosure, the computer-readable storage medium may include the ROM 702 and / or the RAM 703 described above and / or one or more memories other than the ROM 702 and the RAM 703 .
[0126] The embodiments of the present disclosure also include a computer program product, which includes a computer program, and the computer program contains program code for executing the method provided by the embodiments of the present disclosure. When the computer program product runs on an electronic device, the program code is used to enable the electronic device to implement the method provided by the embodiments of the present disclosure.
[0127] When the computer program is executed by the processor 701, the above functions defined in the system / device of the embodiment of the present disclosure are executed. According to the embodiment of the present disclosure, the system, device, module, unit, etc. described above can be implemented by a computer program module.
[0128] In one embodiment, the computer program may rely on tangible storage media such as optical storage devices, magnetic storage devices, etc. In another embodiment, the computer program may also be transmitted and distributed in the form of signals on a network medium, and downloaded and installed through the communication part 709, and / or installed from the removable medium 711. The program code contained in the computer program may be transmitted using any appropriate network medium, including but not limited to: wireless, wired, etc., or any suitable combination of the above.
[0129] According to an embodiment of the present disclosure, the program code for executing the computer program provided by the embodiment of the present disclosure can be written in any combination of one or more programming languages. Specifically, these computing programs can be implemented using high-level process and / or object-oriented programming languages, and / or assembly / machine languages. Programming languages include, but are not limited to, Java, C++, python, "C" language or similar programming languages. The program code can be executed entirely on the user computing device, partially on the user device, partially on the remote computing device, or entirely on the remote computing device or server. In the case of a remote computing device, the remote computing device can be connected to the user computing device through any type of network, including a local area network (LAN) or a wide area network (WAN), or can be connected to an external computing device (for example, using an Internet service provider to connect through the Internet).
[0130] The flowcharts and block diagrams in the accompanying drawings illustrate the possible implementation architecture, functions and operations of the systems, methods and computer program products according to various embodiments of the present disclosure. In this regard, each box in the flowchart or block diagram may represent a module, a program segment, or a part of a code, and the above-mentioned module, program segment, or a part of the code contains one or more executable instructions for implementing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box may also occur in an order different from that marked in the accompanying drawings. For example, two boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram or flowchart, and the combination of boxes in the block diagram or flowchart, can be implemented with a dedicated hardware-based system that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions. It can be understood by those skilled in the art that the features recorded in the various embodiments of the present disclosure can be combined and / or combined in a variety of ways, even if such a combination or combination is not explicitly recorded in the present disclosure. In particular, without departing from the spirit and teaching of the present disclosure, the features described in the various embodiments of the present disclosure may be combined and / or combined in a variety of ways. All of these combinations and / or combinations fall within the scope of the present disclosure.
[0131] The embodiments of the present disclosure are described above. However, these embodiments are only for illustrative purposes and are not intended to limit the scope of the present disclosure. Although the embodiments are described above, this does not mean that the measures in the various embodiments cannot be used in combination to advantage. The scope of the present disclosure is limited by the attached embodiments and their equivalents. Without departing from the scope of the present disclosure, those skilled in the art may make a variety of substitutions and modifications, which should all fall within the scope of the present disclosure.
Claims
1. A method for measuring the tension of a continuum robot driving rope, comprising: Acquire a pre-established mapping relationship between the tension of a driving rope and the current of a driving motor, wherein the continuum robot includes a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto; When the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, collecting a target current of the current driving motor; The current driving rope tension is obtained according to the target current and the mapping relationship.
2. The method according to claim 1, wherein: In the case where the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, collecting the target current of the current driving motor includes: Within a first predetermined time range, continuously collecting the current driving the motor to obtain a plurality of first initial currents; An average value of the plurality of first initial currents is calculated to obtain the target current.
3. The method according to claim 1, wherein: The mapping relationship is obtained according to the following operations: In the case where the continuum robot includes a plurality of continua and a plurality of drive ropes corresponding to each continuum, and each drive rope is driven by a motor corresponding thereto, a force sensing device is connected to the drive rope included in the continuum robot; Driving the motor to rotate and gradually tightening the driving rope; When the drive rope is in each predetermined tension state, the drive rope tension is sensed according to the force sensing device, and the current driving the motor is continuously collected within a second predetermined time range to obtain a plurality of second initial currents; The mapping relationship is obtained according to the sensed drive rope tensions corresponding to each of a plurality of predetermined tensioning states and the plurality of second initial currents.
4. The method according to claim 3, wherein: The mapping relationship is obtained according to the sensed drive rope tensions and the plurality of second initial currents corresponding to the plurality of predetermined tension states, respectively, including: For each predetermined tensioning state, calculating a current average of a plurality of second initial currents corresponding to the predetermined tensioning state; constructing a set of linear equations related to the sensed drive rope tension and the current mean value according to the sensed drive rope tension and the current mean value corresponding to each of a plurality of predetermined tensioning states; The linear equations are solved using least squares to obtain the mapping relationship.
5. The method according to claim 3, wherein: In each linear equation included in the linear equation group, the sensed driving rope tension and the current mean value satisfy the relationship in the following formula (I): (one) in, Characterizes the sensed driving rope tension measured by the force sensing device when the driving rope is in the tensioned state i, represents the current mean value corresponding to the tension state i when the drive rope is in the tension state i, k represents the slope, and b represents the intercept.
6. The method according to claim 3, wherein: The mapping relationship is obtained according to the sensed drive rope tensions and the plurality of second initial currents corresponding to the plurality of predetermined tension states, respectively, including: For each predetermined tension state, calculating a current mean and a standard deviation of a plurality of second initial currents corresponding to the predetermined tension state; The mapping relationship is obtained according to the current mean value, the standard deviation and the target driving rope tension corresponding to each of a plurality of predetermined tensioning states.
7. The method according to claim 3, wherein: In the case where the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state, before collecting the target current of the current driving motor, the method further includes: The force sensing device is removed from the drive rope.
8. The method according to any one of claims 1 to 7, wherein: The continuum robot further includes: a first continuum portion and a second continuum portion, wherein each of the first continuum portion and the second continuum portion is driven by a predetermined number of the driving ropes.
9. The method according to claim 8, wherein: Each continuum portion includes a plurality of control rings, a plurality of connecting rods and a plurality of two-way joints, wherein the control rings are fixed on the connecting rods and have holes uniformly opened around them for the driving ropes to pass through, the control rings are alternately connected to the two-way joints, and the two-way joints are used to realize the bending and deflection of each continuum when the predetermined number of driving ropes drive each continuum portion to move.
10. A device for measuring the tension of a continuum robot driving rope, comprising: An acquisition module is used to acquire a pre-established mapping relationship between the tension of a driving rope and the current of a driving motor, wherein the continuum robot includes a plurality of continua and a plurality of driving ropes corresponding to each continuum, and each driving rope is driven by a motor corresponding thereto; A collection module, used for collecting a target current of the current driving motor when the motor is used to drive the driving rope in the continuum robot to move, thereby controlling the continuum robot to move to a predetermined state; The obtaining module is used to obtain the current driving rope tension according to the target current and the mapping relationship.
Citation Information
Patent Citations
Medium feeding control method and medium feeding apparatus
CN105882167A
Method and device for sensing tail end force of rope-driven flexible mechanical arm without external sensor
CN112917469A
Automatic high-precision resetting method for rope-driven flexible mechanical arm based on tool condition
CN113043270A
Sueding machine tension control system, method and device and sueding machine system
CN113802313A
Strength training apparatus and control method thereof
CN117298514A
Cited By
Automatic leveling control method for snakelike flexible mechanical arm
CN119927887A
