Flexible instrument shape determination method, system and device and nonvolatile storage medium
Through multi-directional plane calibration and curvature measurement error correction, the problem of inaccuracy determination of shape caused by the difference in curvature measurement sensitivity of flexible instruments in different directions is solved, and the accurate determination of the shape of flexible instruments is achieved.
Patent Information
- Application Number
- CN202411243815.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-05
- Publication Date
- 2024-11-12
AI Technical Summary
The prior art does not take into account the sensitivity differences in curvature measurement in different directions when calibration of flexible instruments, resulting in the inability to accurately determine the shape of the flexible instrument.
The multi-directional plane calibration method is adopted to obtain the correlation relationship between the curvature measurement error and the shape determination parameter error of the flexible instrument in multiple preset bending directions, correct the initial shape determination parameters, and then determine the target shape of the flexible instrument.
Accurate determination of the shape of the flexible instrument is achieved, the problem that the calibration results do not match the actual shape is solved, and the accuracy of shape determination is improved.
Smart Images

Figure CN118936358A_ABST
Abstract
Description
Technical Field
[0001] Embodiments of the present application relate to the field of medical devices, and in particular, to a method, system, device and non-volatile storage medium for determining the shape of a flexible device. Background Art
[0002] Fiber optic shape sensors can be used to measure the real-time shape of flexible devices such as optical fibers. In order to more accurately determine the real-time shape of the flexible device, it is necessary to first calibrate the various shape determination parameters of the flexible device, and determine the real-time shape of the flexible device based on the calibration results and the real-time strain of the flexible device. However, in the current related technology, when calibrating flexible devices, the method usually used is to perform a linear calibration and a single plane calibration to obtain the calibration result. The problem with this method is that it does not take into account that the flexible device is bent in space in the actual working environment, and may have different bending directions, and the curvature measurement sensitivity of the flexible device in different bending directions is different, resulting in the calibration result being inconsistent with the actual situation of the flexible device, which in turn leads to the inability to accurately determine the shape of the flexible device. Summary of the invention
[0003] The embodiments of the present application provide a method, system, device and non-volatile storage medium for determining the shape of a flexible device, so as to at least solve the technical problem in the related art that the shape of the flexible device cannot be accurately determined due to the different curvature measurement sensitivities of the flexible device in different directions not being taken into account when calibrating the flexible device.
[0004] The embodiment of the present application provides a method for determining the shape of a flexible device, including: determining a straight line calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the straight line calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to the flexible device in each preset bending direction; determining the correlation between the curvature measurement error of the flexible device and the shape determination parameter error based on the straight line calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device A system, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameters include an initial strain coefficient of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores, and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters; the target wavelength of the flexible device is determined at the target time, and the shape of the flexible device at the target time is determined according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0005] Optionally, the shape determination parameter error includes the error between the initial shape parameters and the true values of the shape parameters of the flexible instrument, the curvature measurement error includes the error between the curvature measurement value and the true value of the curvature of the flexible instrument, and the straight line calibration result and the unidirectional plane calibration result are also used to determine the initial calibration angle; determining the correlation between the curvature measurement error and the shape determination parameter error of the flexible instrument based on the straight line calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape determination parameters of the flexible instrument includes: determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration result, the multi-directional plane calibration result, the initial shape determination parameters and the true value of the curvature of the flexible instrument.
[0006] Optionally, the true value of curvature includes a horizontal component of the true value of curvature and a vertical component of the true value of curvature; determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration results, the multi-directional plane calibration results, the initial shape determination parameters and the true value of curvature of the flexible device includes: determining the curvature measurement value corresponding to each sensing point in the flexible device in each preset bending direction based on the straight line calibration results, the multi-directional plane calibration results, the initial calibration angle and the initial angle offset, wherein the curvature measurement value corresponding to each sensing point in each preset bending direction includes a horizontal component of the curvature measurement value and a vertical component of the curvature measurement value; constructing a Jacobian matrix based on the curvature measurement value corresponding to each sensing point in each preset bending direction and the initial shape determination parameters; determining a parameter error determination formula based on the Jacobian matrix, wherein the parameter error determination formula is used to reflect the curvature measurement error of the flexible device, the correlation between the Jacobian matrix and the shape determination parameter error.
[0007] Optionally, the elements in the Jacobian matrix include: the calculation result of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial bending direction angle, and the calculation result of the partial derivative of the vertical component of the curvature measurement value with respect to the initial bending direction angle, wherein the initial bending direction angle is the initial value of the angle between the bending direction of the sensing point and the horizontal direction, and the bending direction is the normal direction of the curve at the sensing point; the calculation result of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial fiber core spacing, and the calculation result of the partial derivative of the vertical component of the curvature measurement value with respect to the initial fiber core spacing; the calculation result of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial angle offset, and the calculation result of the partial derivative of the vertical component of the curvature measurement value with respect to the initial angle offset; the calculation result of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial strain coefficient, and the calculation result of the partial derivative of the vertical component of the curvature measurement value with respect to the initial strain coefficient.
[0008] Optionally, determining the shape of the flexible device at the target moment based on the target wavelength, the reference wavelength and the target shape determination parameters includes: determining the strain of the flexible device at the target moment based on the target wavelength, the reference wavelength and the target shape determination parameters in the target shape strain coefficient; determining the target curvature and target bending direction angle of each sensing point in the flexible device at the target moment based on the strain and the target calibration angle, the target core pitch and the target angle offset in the target shape determination parameters, wherein the target bending direction angle is the angle between the bending direction of the sensing point and the reference direction, and the bending direction is the normal direction of the curve at the sensing point; determining the shape of the flexible device at the target moment based on the target curvature and target bending direction angle of each sensing point at the target moment, and the position information of each sensing point on the flexible device along the arc length direction of the flexible device.
[0009] Optionally, the reference wavelength includes an intermediate core reference wavelength of the intermediate core and a surrounding core reference wavelength of the surrounding cores, the first calibration wavelength includes a first intermediate core calibration wavelength of the intermediate core and a first surrounding core calibration wavelength of the surrounding cores, the second calibration wavelength includes a second intermediate core calibration wavelength of the intermediate core and a second surrounding core calibration wavelength of the surrounding cores, and the target wavelength includes a target intermediate core wavelength of the intermediate core and a target surrounding core wavelength of the surrounding cores.
[0010] Optionally, each preset bending direction corresponds to a rotation direction of the flexible device, and there is a corresponding rotation direction in each quadrant of the preset plane rectangular coordinate system, and the plane where the preset plane rectangular coordinate system is located is a plane perpendicular to the axial direction of the flexible device.
[0011] Optionally, each sensing point in the flexible device corresponds to an initial calibration angle, and each sensing point corresponds to a grating set on the middle fiber core and multiple gratings set on different surrounding fiber cores, the initial calibration angle is the angle between the positive direction of the horizontal axis in the rectangular coordinate system of the target plane and any surrounding fiber core, wherein the rectangular coordinate system of the target plane is a coordinate system set in the target plane corresponding to the sensing point, and the angle between the surrounding fiber core and the positive direction of the horizontal axis is determined in the following manner: connect the coordinate origin of the rectangular coordinate system of the target plane and the center point of the surrounding fiber core in the target plane to obtain a reference line segment with a direction pointing from the coordinate origin to the center point, wherein the center point is the corresponding point of the grating in the surrounding fiber core in the target plane, and the origin is the corresponding point of the grating in the middle fiber core in the target plane; determine the angle between the reference line segment and the positive direction of the horizontal axis as the angle between the surrounding fiber core and the positive direction of the horizontal axis.
[0012] The embodiment of the present application also provides a flexible device shape determination system, including a calibration module and a real-time measurement module, wherein the calibration module is used to determine the straight line calibration result and the plane calibration result of the flexible device, wherein the plane calibration result includes the unidirectional plane calibration result and the multi-directional plane calibration result, the straight line calibration result includes the reference wavelength of the flexible device, the unidirectional plane calibration result includes the first calibration wavelength of the flexible device, and the multi-directional plane calibration result includes the second calibration wavelength corresponding to the flexible device in each preset bending direction; according to the straight line calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape determination parameter of the flexible device, the curvature measurement error and the shape determination parameter error of the flexible device are determined. The invention discloses a method for determining a flexible device according to the present invention, wherein the flexible device comprises an intermediate fiber core and multiple surrounding fiber cores, the initial shape determination parameters comprise an initial strain coefficient of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, the initial calibration angle being used to determine the degree of torsion of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters; a real-time measurement module is used to determine the target wavelength of the flexible device at the target time, and determine the shape of the flexible device at the target time according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0013] The embodiment of the present application also provides a flexible device shape determination device, including: a first processing module, used to determine the straight line calibration result and the plane calibration result of the flexible device, wherein the plane calibration result includes the unidirectional plane calibration result and the multi-directional plane calibration result, the straight line calibration result includes the reference wavelength of the flexible device, the unidirectional plane calibration result includes the first calibration wavelength of the flexible device, and the multi-directional plane calibration result includes the second calibration wavelength corresponding to the flexible device in each preset bending direction; a second processing module, used to determine the correlation between the curvature measurement error of the flexible device and the shape determination parameter error based on the straight line calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape determination parameters of the flexible device relationship, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, the initial shape determination parameters include the initial strain coefficient of the flexible device, the initial calibration angle, the initial angle offset between any two adjacent surrounding fiber cores and the initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; a third processing module is used to correct the initial shape determination parameters according to the curvature measurement error of the flexible device in each preset bending direction and the associated relationship to obtain the target shape determination parameters; a fourth processing module is used to determine the target wavelength of the flexible device at the target moment, and determine the shape of the flexible device at the target moment according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0014] The embodiment of the present application also provides a non-volatile storage medium, in which a computer program is stored. When the computer program is executed by a processor, the method for determining the shape of a flexible instrument is implemented.
[0015] An embodiment of the present application also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the method for determining the shape of a flexible instrument is implemented when the processor executes the computer program.
[0016] The embodiment of the present application also provides a computer program product, including a computer program, which implements a method for determining a shape of a flexible instrument when executed by a processor.
[0017] Based on the above scheme, it can be known that the present application obtains the multi-directional plane calibration results of the flexible instrument, and determines the correlation between the curvature measurement error and the shape determination parameter error of the flexible instrument based on the multi-directional plane calibration results of the flexible instrument, thereby correcting the shape determination parameters of the flexible instrument, and determining the shape of the flexible instrument based on the corrected shape determination parameters, thereby achieving the technical effect of accurately determining the real-time shape of the flexible instrument, and solving the technical problem in the related art that when calibrating the flexible instrument, the different curvature measurement sensitivities of the flexible instrument in different directions are not taken into account, resulting in the inability to guarantee the accuracy of the calibration process when calibrating the shape determination parameters of the flexible instrument, resulting in the shape determination parameters obtained by calibration being inconsistent with the actual shape determination parameters of the flexible instrument, resulting in the inability to accurately determine the shape of the flexible instrument. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the related technologies, the following is a brief introduction to the drawings required for use in the embodiments or the related technical descriptions. Obviously, the drawings described below are some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0019] Figure 1 A schematic diagram of an application scenario of the optical fiber shape sensing technology provided in an exemplary embodiment of the present application;
[0020] Figure 2 A schematic diagram of the principle of a fiber strain grating provided in an exemplary embodiment of the present application;
[0021] Figure 3 A schematic diagram of another fiber strain grating principle provided in an exemplary embodiment of the present application;
[0022] Figure 4A schematic diagram of the structure of a flexible device shape determination system provided in an exemplary embodiment of the present application;
[0023] Figure 5 A schematic diagram of the hardware composition of another flexible instrument shape determination system provided in an exemplary embodiment of the present application;
[0024] Figure 6 A schematic flow chart of a method for determining the shape of a flexible device provided in an exemplary embodiment of the present application;
[0025] Figure 7 A schematic diagram of a flexible device and a cross section of the flexible device provided in an exemplary embodiment of the present application;
[0026] Figure 8 A schematic diagram of a straight line calibration scenario provided in an exemplary embodiment of the present application;
[0027] Fig. 9 A schematic diagram of a plane calibration scene provided in an exemplary embodiment of the present application;
[0028] Fig.10 A schematic diagram of a multi-directional bending scene of a flexible device provided in an exemplary embodiment of the present application;
[0029] Fig.11 A schematic cross-sectional view of a flexible device provided in an exemplary embodiment of the present application when the flexible device has internal torsion;
[0030] Fig.12 A flow chart of a parameter correction process provided in an exemplary embodiment of the present application;
[0031] Fig.13 A schematic diagram of a process flow of determining a flexible device shape in a related art provided in an exemplary embodiment of the present application;
[0032] Fig.14 A schematic diagram of a scene of a handheld working scene of a flexible instrument provided in an exemplary embodiment of the present application;
[0033] Fig.15 A schematic diagram of a working scene of a flexible instrument robot system provided in an exemplary embodiment of the present application;
[0034] Fig.16 A schematic diagram of a robot flexible arm provided in an exemplary embodiment of the present application;
[0035] Fig.17 A schematic diagram of the structure of a flexible instrument shape determination device provided in an exemplary embodiment of the present application;
[0036] Fig.18 A schematic diagram of the structure of an electronic device provided in an exemplary embodiment of the present application. DETAILED DESCRIPTION
[0037] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0038] It should be noted that the terms "first", "second", etc. in the specification and claims of the present application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments of the present application described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0039] The technical solution of the present application is described in detail with specific embodiments below. The following specific embodiments can be combined with each other, and the same or similar concepts or processes may not be described in detail in some embodiments.
[0040] Fiber Optic Shape Sensing (FOSS) technology for shape sensing of flexible devices such as optical fibers first appeared in the mid-1980s and was used to measure the strain and curvature of simple flexible devices. With the continuous improvement of sensor performance, FOSS technology has begun to be widely used in various two-dimensional and three-dimensional shape sensing application scenarios, covering aerospace, construction, medical and other fields. The advantages of FOSS as a shape sensing technology include: 1) anti-electromagnetic interference; 2) small size (the diameter of the optical fiber used for sensing is generally within 250μm); 3) fast detection speed; 4) multiple sensing points or multiplexing; 5) simple system integration; 6) high mechanical strength.
[0041] Figure 1 This is a schematic diagram of the application scenarios of FOSS technology in the medical field. Figure 1It can be seen that by integrating the three-dimensional shape sensors of flexible instruments such as optical fibers into the endoscope, the shape of the endoscope can be displayed in real time during the operation, which facilitates the doctor's operation and greatly shortens the operation time.
[0042] The basis of FOSS technology is strain sensing of flexible devices. Currently, the two most common principles are fiber Bragg Grating (FBG) and Rayleigh scattering.
[0043] Among them, FBG is the smallest sensing unit in FBG-based strain sensing, which is a short-distance point measurement. FBG is a microstructure processed on optical fiber. The commonly used technology is to modify its material through ultraviolet laser irradiation or femtosecond laser processing. The place where FBG is engraved is equivalent to having a "reflector" that can reflect light of a specific wavelength. Strain detection can only be performed at the point where FBG is engraved. FBG-based strain sensing uses a broadband light source to measure strain by detecting the change in the wavelength reflected back by each discretely distributed FBG relative to the reference wavelength. The principle of flexible instrument strain sensor based on FBG is as follows: Figure 2 As shown, the microstructure (vertical line) in the figure is a Bragg grating that can reflect light of a specific wavelength.
[0044] The strain sensing technology based on Rayleigh scattering does not theoretically require the writing of gratings. The basic sensing unit is the optical fiber itself. Since the scattering occurs over the entire length of the optical fiber, it has a nearly continuous spatial strain sensing resolution. Optical frequency domain reflectometry (OFDR) is the main interrogation technology used in this technology. OFDR uses a narrowband light source to measure strain by detecting changes in scattering frequency at each point on the optical fiber. It is a distributed measurement method. Although OFDR can theoretically achieve higher spatial resolution than FBG, the light source cost and sensor cost of this solution are relatively high, about 4-5 times that of the latter. The principle schematic diagram of the optical fiber strain sensor based on Rayleigh scattering is shown in the figure. Figure 3 As shown, it can be seen that there is no need to perform micro-machining on the optical fiber, and the entire optical fiber can be directly tested.
[0045] At present, in the relevant technologies in the medical field, there are many methods for positioning flexible instruments by determining the shape of the flexible instruments. And the shape determination methods used when determining the shape of the flexible instruments are mostly FBG-based shape determination methods. However, although the related technologies provide methods for positioning flexible instruments according to the shape of the flexible instruments, because the related technologies usually only perform one linear calibration and one unidirectional plane calibration when calibrating the flexible instruments, it does not take into account that the flexible instruments are bent in space in the actual working environment, and may have different bending directions, and the curvature measurement sensitivity of the flexible instruments in different bending directions is different. As a result, the shape of the flexible instrument cannot be accurately determined in the related technologies, making the positioning results not accurate enough.
[0046] In order to solve the above problems, the present application provides an embodiment of a method for determining the shape of a flexible device. The technical solutions provided by each embodiment of the present specification are described in detail below in conjunction with the accompanying drawings. It should also be noted that the flexible device referred to in the embodiment of the present application includes optical fibers, etc.
[0047] The method for determining the shape of a flexible device provided in the embodiment of the present application can be used in Figure 4 Runs in the system shown. Figure 4 It can be seen that the system includes a calibration module 40 and a real-time measurement module 42, wherein the calibration module 40 is used to determine the linear calibration result and the plane calibration result of the flexible device, wherein the plane calibration result includes the unidirectional plane calibration result and the multidirectional plane calibration result, the linear calibration result includes the reference wavelength of the flexible device, the unidirectional plane calibration result includes the first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes the second calibration wavelength corresponding to the flexible device in each preset bending direction; according to the linear calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device, the relationship between the curvature measurement error of the flexible device and the shape determination parameter error is determined. The flexible device comprises an intermediate fiber core and a plurality of surrounding fiber cores, the initial shape determination parameters comprise an initial strain coefficient of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, the initial calibration angle being used to determine the torsion direction of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the association relationship to obtain the target shape determination parameters; a real-time measurement module 42 is used to determine the target wavelength of the flexible device at the target moment, and determine the shape of the flexible device at the target moment according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0048] In some embodiments of the present application, the hardware components of the flexible instrument shape determination system are as follows: Figure 5As shown, it includes a demodulator 50, an electronic device 52, a fan-in fan-out device 54 and a flexible device shape grating 56. Among them, the demodulator 50 is used to provide a light source for the grating, and at the same time demodulates the wavelength information returned from the grating end, and transmits the information to the electronic device 52 (controller, PC), etc. for subsequent calculations. The electronic device 52 can be used to receive the wavelength information of the demodulator 50, run the shape reconstruction program, and display the shape of the flexible device in real time. In addition Figure 4 The system shown in FIG. 5 can also be operated in an electronic device 52. The fan-in fan-out device is a passive component that can transmit the wavelength information of different fiber cores of the shaped grating to several single-mode flexible devices (Single-Mode Fiber, SMF) respectively, and transmit it to the demodulator 50. The flexible device shaped grating 54 is used to measure the curvature of the flexible device. A typical application is to measure a multi-core flexible device (Multi-core Optic Fiber, MCF) engraved with FBG.
[0049] Figure 6 A flowchart of a method for determining the shape of a flexible device provided in an embodiment of this specification specifically includes the following steps:
[0050] Step 602, determining a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device;
[0051] As an optional implementation, a calibration result corresponding to a preset bending direction may be selected from the multi-directional plane calibration results as the single-directional plane calibration result.
[0052] In some embodiments of the present application, Figure 7 As shown, the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, the reference wavelength includes the intermediate fiber core reference wavelength of the intermediate fiber core and the surrounding fiber core reference wavelength of the surrounding fiber cores, the first calibration wavelength includes the first intermediate fiber core calibration wavelength of the intermediate fiber core and the first surrounding fiber core calibration wavelength of the surrounding fiber cores, and the second calibration wavelength includes the second intermediate fiber core calibration wavelength of the intermediate fiber core and the second surrounding fiber core calibration wavelength of the surrounding fiber cores.
[0053] Optionally, from Figure 7 It can be seen that the multiple peripheral fiber cores in the flexible device are usually arranged at regular angles, that is, the angle formed by any two adjacent peripheral fiber cores and the middle fiber core in any cross section of the flexible device is the same value. Figure 7When three are shown, the angle of the above-mentioned angle is 120°.
[0054] In the embodiment of the present application, for the convenience of description, the middle fiber core is marked as c and the surrounding fiber cores are marked as i. i It is the angle between the surrounding fiber core i and the horizontal axis (X-axis). The value of i is determined by the number of surrounding fiber cores. For example, when there are three surrounding fiber cores, the value of i is 1, 2, and 3, and the numbers of the surrounding fiber cores are in a counterclockwise order. It should also be noted that in the relevant formulas of the embodiments of the present application, for the sake of ease of description, the parameters related to the surrounding fiber cores other than the core spacing and the angle offset are all based on the relevant parameters of the surrounding fiber core labeled 1. The angle between adjacent fiber cores is represented by the core angle offset Δθ, which is generally 120°, that is, the surrounding fiber cores are evenly distributed. If there are six surrounding fiber cores, Δθ=60°. r is the core spacing, which refers to the distance from the middle fiber core to each surrounding fiber core, κ is the curvature of the flexible device, θ b Describes the direction of curvature (bending), that is, the bending direction angle. The bending direction angle corresponding to the sensing point is the angle between the normal direction of the flexible device at that point and the reference direction, and the normal direction points to the center of the circle.
[0055] As an optional implementation, the calibration scenario of the straight line calibration is as follows: Figure 8 As shown, the flexible device needs to be straightened during calibration, and the reference wavelength of different fiber cores, i.e., the wavelength when no bending strain is generated, including the intermediate fiber core reference wavelength λ of the intermediate fiber core is read by the fiber grating demodulator. c,0 and the surrounding core reference wavelength λ of the surrounding core i,0 In addition, when performing linear calibration, the first and last positions of the grating sensing area of the MCF shape sensor need to be fixed.
[0056] The calibration scenario for single-direction plane calibration is as follows: Fig. 9 As shown, during calibration, the flexible device needs to be bent into any shape on the plane, and the fiber grating demodulator transmits the read wavelength to the PC to determine the first intermediate core calibration wavelength λ of the intermediate core at this time. c,calib and the first surrounding core calibration wavelength λ of the surrounding core i,calib In addition to calibrating the wavelength, plane calibration can also be used to determine the calibration angle θ at each sensing point in the flexible device. calib In addition, when determining the calibration angle, in order to facilitate calculation, the bending direction angle measured in the xy plane of the reference coordinate system can be set to 0 when setting the coordinate system. The value calculated at this time is the torsion angle caused by the processing error, which is also the value that should be compensated later.
[0057] Since flexible devices are used in actual Fig.10As shown, multi-directional bending is usually performed, and since the curvature measurement sensitivity of the flexible device is different in different bending directions, in order to accurately determine the shape of the flexible device, in addition to linear calibration and unidirectional plane calibration, multi-directional plane calibration is also required for the flexible device. Among them, when performing multi-directional plane calibration on the flexible device, it can be considered that the flexible device is rotated by a preset angle multiple times, and a unidirectional plane calibration is performed after each rotation of the preset angle.
[0058] Optionally, each of the above-mentioned preset bending directions corresponds to a rotation direction of the flexible device, and each quadrant of the preset plane rectangular coordinate system has a corresponding rotation direction, and the plane where the preset plane rectangular coordinate system is located is a plane perpendicular to the axial direction of the flexible device. For example, the flexible device can be rotated in the 0° direction and a wavelength of λ is recorded. c,1 , i,1 ; Rotate the flexible device 90° and record a wavelength of λ c,2 , i,2 , and so on, the angle selection and number of times of the flexible device can be adjusted according to actual needs, and at least 360° data collection must be completed, that is, at least data must be collected at 0°, 90°, 180°, and 270°. More data can be collected during actual operation. For example, data can be collected several times in the 90° direction. It should also be noted that the angle of each rotation can also be different, as long as the above-mentioned rotation angle is ensured in each quadrant. In this way, through multi-directional calibration, a data set (λ) containing the second intermediate fiber core calibration wavelength and the second surrounding fiber core calibration wavelength corresponding to different preset bending directions can be obtained. c,1 ,λ i,1 ; c,2 ,λ i,2 ; c,3 ,λ i,3 ; c,4 ,λ i,4 ; c,5 ,λ i,5 ; c,6 ,λ i,6 ; ...), where 1, 2, 3, 4, 5, 6 in the data set represent different preset bending directions.
[0059] In addition, when calibrating the flexible instrument in multiple directions, the robot can be controlled to automatically bend the flexible instrument in different directions, or the operator can manually operate the catheter rotating device to bend the flexible instrument in different directions, thereby obtaining the true value of the curvature in different preset bending directions. And during the calibration process, the calibration tool can be used to assist in the calibration.
[0060] In some embodiments of the present application, when determining the shape of the flexible device, in addition to various calibration results, it is also necessary to apply the fiber core distance r, the gauge coefficient S directly provided by the manufacturer. ∈ , core angle offset Δθ, position s of each sensing point along the arc length direction and other parameters. Fig.11 As shown in the fiber core twisting and other situations, it is usually not possible to accurately determine the shape of the flexible device when the parameters provided by the manufacturer are directly used to determine the shape of the flexible device. Therefore, it is necessary to calibrate various parameters before determining the shape of the flexible device.
[0061] Step 604, determining the correlation between the curvature measurement error and the shape determination parameter error of the flexible device according to the linear calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameter includes an initial strain factor of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device;
[0062] In the technical solution provided in step 604, each sensing point in the flexible device corresponds to an initial calibration angle, and each sensing point corresponds to a grating set on the middle fiber core and multiple gratings set on different surrounding fiber cores, the initial calibration angle is the angle between the positive direction of the horizontal axis in the rectangular coordinate system of the target plane and any surrounding fiber core, wherein the rectangular coordinate system of the target plane is a coordinate system set in the target plane corresponding to the sensing point, and the angle between the surrounding fiber core and the positive direction of the horizontal axis is determined in the following manner: connect the coordinate origin of the rectangular coordinate system of the target plane and the center point of the surrounding fiber core in the target plane to obtain a reference line segment with a direction pointing from the coordinate origin to the center point, wherein the center point is the corresponding point of the grating in the surrounding fiber core in the target plane, and the origin is the corresponding point of the grating in the middle fiber core in the target plane; determine that the angle between the reference line segment and the positive direction of the horizontal axis is the angle between the surrounding fiber core and the positive direction of the horizontal axis.
[0063] The calibration angle corresponding to each sensing point can be used to determine the conversion relationship between the world coordinate system and the plane rectangular coordinate system in the cross section where the optical fiber point is located, which can be used to reconstruct the shape of the flexible device. In addition, the coordinates of each sensing point in the world coordinate system can be determined by the wavelength corresponding to the sensing point. In addition, the above-mentioned target plane refers to the cross section of the flexible device passing through each sensing point.
[0064] In some embodiments of the present application, the calibration angle θ calib and Figure 7 The angles θ1 shown in FIG. 1 are equal in magnitude and opposite in direction. Specifically, in FIG. Figure 7 In the cross section of a certain sensing point of the flexible device shown in the figure, the bending direction angle θ corresponding to the sensing point b , θ1 is related to the local coordinate system defined, and θ b The difference between θ1 and the strain ∈ i Related to, and ∈ i has a definite physical meaning and will not change due to different choices of coordinate systems, so θ b -θ1 must be a constant. Fix the starting point of the flexible instrument's sensing area on the table and bend the flexible instrument into an arc on the horizontal plane. Assuming θ1 = 0, the calculated θ b is θ calib , at this time θ b -θ1=θ calib Since the bending direction angle of the plane bending is zero, θ b =0, we can get 0-θ1=θ calib , so θ calib =-θ1.
[0065] In some embodiments of the present application, the real-time curvature of the flexible instrument is related to θ b The relationship between them is as follows:
[0066] κ x =κcos(θ b ) (1)
[0067] κ y =κsin(θ b ) (2)
[0068] In the above formula, κ x is the horizontal component of the real-time curvature, κ y is the vertical component of the real-time curvature.
[0069] Therefore, the true value of θ1 is different from the plane calibration result θ calib When calculating the shape in real time, let θ1 = 0, and the calculated bending angle is θ b , the result needs to be compensated, θ b =θ b +θ1=θ b -θ calib Although the initial calibration angle can be determined by the linear calibration results and the single-direction plane calibration results, in order to ensure the accuracy of the shape determination results, θ_calib still needs to be corrected based on the multi-direction plane calibration results.
[0070] In some embodiments of the present application, taking the number of surrounding fiber cores as three as an example, when the flexible device is plane-calibrated, the strain formula of the flexible device is as follows:
[0071]
[0072] In the above formula, S ∈ and S T are the strain sensitivity coefficient and the temperature sensitivity coefficient, respectively, which are used to describe the relationship between the wavelength shift and the core strain and the core temperature change; Δλ c,calib is the offset of the middle core, Δλ i,calib is the offset of the ith surrounding core, λ c,0 is the reference wavelength of the middle core, λ i,0 is the reference wavelength of the ith surrounding fiber core. The reference wavelength is the initial wavelength without bending strain, that is, the wavelength determined during straight line calibration. ΔT is the temperature change.
[0073] Combining the above two strain formulas, we can get the following formula (5):
[0074] Δλ i,calib -Δλ c,calib =S ∈∈i,calib ,i=1,2,3
[0075] ∈ i,calib =1 / S ∈ (Δλ i,calib -Δλ c,calib ),i=1,2,3 (5)
[0076] In order to simplify the calculation process, considering that the size of flexible devices such as flexible instruments is usually small, it can be assumed that the wavelength change of the middle fiber core and the surrounding fiber core in the same cross section is affected by temperature in the same way, both of which are S T ΔT.
[0077] In addition, from a mechanical point of view, since the middle fiber core is on the neutral layer and has no bending strain, its wavelength change is only affected by temperature. Therefore, the wavelength change of the surrounding fiber cores can be regarded as the sum of the wavelength change caused by the bending strain of the surrounding fiber cores and the wavelength change of the middle fiber core affected by temperature, which is the second strain formula mentioned above.
[0078] From a geometric perspective, we can get the following formula:
[0079] ∈ i,calib = -κrcos(θ b -θ i ),i=1,2,3 (6)
[0080] θ i =θ1+(i-1)·Δθ,i=1,2,3 (7)
[0081] Combining the above formulas (6) and (7), and setting θ1 = 0, θb =θ calib , we can get:
[0082] ∈ i,calib = -κrcos(θ calib -(i-1)·Δθ), i=1,2,3 (8)
[0083] Due to symmetry, the formula ∈ i,calib = -κrcos(θ b -θ i ), i=1,2,3, and combined with formulas (1), (2) and (7), we get the following formula:
[0084]
[0085] θ calib =ANGLE(κ x ,κ y ) (12)
[0086] In some embodiments of the present application, when calculating the shape of the flexible device, in order to simplify the calculation, the value of θ1 in formula (9) (10) can still be set to zero, which is equivalent to adding a true value of θ1 to the right side of the relevant formula, that is, -θ calib .
[0087] As an optional implementation, the shape determination parameter error includes the error between the initial shape parameters and the true values of the shape parameters of the flexible instrument, the curvature measurement error includes the error between the curvature measurement value and the true value of the curvature of the flexible instrument, and the straight line calibration results and the plane calibration results are also used to determine the initial calibration angle; based on the straight line calibration results, the single-direction plane calibration results, the multi-direction plane calibration results and the initial shape determination parameters of the flexible instrument, determining the correlation between the curvature measurement error and the shape determination parameter error of the flexible instrument includes: determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration results, the multi-direction plane calibration results, the initial shape determination parameters and the true value of the curvature of the flexible instrument.
[0088] Optionally, the horizontal and vertical components of the true curvature value can be directly obtained through the robot control algorithm, or the operator can use the tooling to calibrate in the scene of a handheld mirror to determine. When the operator uses the tooling to calibrate, there will be a preset arc with a known curvature on the tooling. Assuming that the angle between the tooling plane and the horizontal plane is β, the true curvature κ in the horizontal direction is gt,x =κ gt cosβ, the true value of the vertical curvature κ gt,y =κ gt sinβ.κ gt , κ gt,x and κgt,y are all N*1 vectors, either with constant curvature, i.e., κ gt In are equal, and may not be constant curvature, i.e., κ gt In are not all equal, j represents the jth sensing point in the flexible device, the subscript gt indicates that the parameter is a true value, and N is the number of sensing points.
[0089] In some embodiments of the present application, the true value of curvature includes a horizontal component of the true value of curvature and a vertical component of the true value of curvature; determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration results, the multi-directional plane calibration results, the initial shape determination parameters and the true value of curvature of the flexible device includes: determining the curvature measurement value corresponding to each sensing point in the flexible device in each preset bending direction based on the straight line calibration results, the multi-directional plane calibration results, the initial calibration angle and the initial angle offset, wherein the curvature measurement value corresponding to each sensing point in each preset bending direction includes a horizontal component of the curvature measurement value and a vertical component of the curvature measurement value; constructing a Jacobian matrix based on the curvature measurement value corresponding to each sensing point in each preset bending direction and the initial shape determination parameters; determining a parameter error determination formula based on the Jacobian matrix, wherein the parameter error determination formula is used to reflect the curvature measurement error of the flexible device, the correlation between the Jacobian matrix and the shape determination parameter error.
[0090] Optionally, when calibrating the parameters, the intermediate fiber core reference wavelength λ c,0 and the surrounding core reference wavelength λ i,0 ; The second intermediate core calibration wavelength λ of the multi-directional plane calibration c,k , the second surrounding core calibration wavelength λ i,k (k is an integer between 1 and M, where M represents the number of the preset bending direction); core distance r, strain sensitivity coefficient S ∈ , core angle offset Δθ; calibration angle θ calib , and the true value of curvature κ gt , to obtain the corrected parameters target core distance r_cor, target shape strain coefficient S ∈ _cor, target calibration angle θ calib _cor and target angle offset Δθ_cor.
[0091] As an optional implementation, from the above formulas (3)-(12), [κ x ,κ y ]=f(θ calib ,Δθ,r,S ∈ ,λ i,0 ,λ c,0 ,λ i,k ,λ c,k), and κ x ,κ y With θ calib ,Δθ,r,S ∈ The correlation between them is a nonlinear relationship. In order to quantitatively determine the parameter error and make corrections based on the curvature error, it is necessary to convert the nonlinear problem into a linear problem and solve the relationship between the small change in curvature and the small change in parameter. This relationship can be reflected by the Jacobian matrix. After constructing the Jacobian matrix, the parameter error can be determined based on the curvature error and then parameter compensation can be performed to achieve parameter correction.
[0092] Optionally, the process of modifying the parameters is as follows Fig.12 As shown, the steps include calculating strain, calculating curvature, calculating Jacobian matrix, calculating curvature error dκ, calculating parameter error δParam and parameter correction.
[0093] In the step of calculating strain, the curvature of the flexible device in each preset bending direction needs to be calculated separately. It should also be noted that in the calculation process θ calib Only the first N-1 items are used, that is, the calibration angles corresponding to the sensing points at the end of the flexible instrument will not be used in the calculation process. Therefore, the value range of the superscript j in the following formula is [1, N-1], where N is the total number of sensing points. calib,k Represents a vector with n-1 rows.
[0094] For the preset bending direction k, the corresponding strain can be expressed as follows:
[0095]
[0096] In the above formula, N is the number of sensing points, and M is the number of preset bending directions. Combining formulas (13) and (14), the following formula (15) can be obtained to determine the strain value of each fiber core:
[0097]
[0098] Then, the strain value ∈ of each fiber core in the flexible device can be i,k , initial core distance r, initial angle offset Δθ, initial calibration angle θ calib To calculate the curvature corresponding to each bending direction.
[0099] Taking the bending direction k as an example, the strain value is:
[0100]
[0101] The curvature measurement values in the horizontal and vertical directions can be calculated as shown in formula (16):
[0102]
[0103] After obtaining the horizontal and vertical components of the curvature measurement values corresponding to each preset bending direction, the Jacobian matrix can be further determined to determine the relationship between the curvature error and the parameter error. The small change in the parameter error can be expressed as the following formula (17):
[0104]
[0105] The curvature measurement error at each sensing point can be expressed as follows:
[0106]
[0107] Among them, δκ is a vector with 2*M*(N-1) rows.
[0108] In some embodiments of the present application, the elements in the Jacobian matrix include: the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial bending direction angle, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial bending direction angle, wherein the initial bending direction angle is the initial value of the angle between the bending direction of the sensing point and the horizontal direction, and the bending direction is the normal direction of the curve at the sensing point; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial fiber core spacing, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial fiber core spacing; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial angle offset, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial angle offset; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial strain coefficient, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial strain coefficient.
[0109] In some embodiments of the present application, the expression (19) of the Jacobian matrix J is as follows:
[0110]
[0111] The Jacobian matrix J is a matrix with 2*M*(N-1) rows and (N+2) columns, and T represents transpose. is the horizontal curvature of the jth sensing point in the kth configuration, j∈[1,N-1], N represents the number of sensing points; is the vertical curvature of the jth sensor point in the kth configuration, j∈[1,N-1], N represents the number of sensor points; δ represents the difference between the measured value of the physical quantity (measured) and the true value (ground truth), where δ is used to indicate that this is a small change; are the partial derivatives of the horizontal and vertical curvatures of the j-th point with respect to the initial bending angles of all points, which are vectors of 1*(N-1); are the partial derivatives of the horizontal and vertical curvatures of the j-th point with respect to the core distance, which are scalars; are the partial derivatives of the horizontal and vertical curvatures of the j-th point with respect to the core angle, which are scalars; They are the partial derivatives of the horizontal and vertical curvatures of the j-th point with respect to the strain sensitivity coefficient, and are scalars.
[0112] Step 606, correcting the initial shape determination parameters according to the curvature measurement errors of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters;
[0113] In the technical solution provided in step 606, the parameter error determination formula of the relationship between the curvature measurement error δκ, the Jacobian matrix J reflecting the association relationship, and the parameter error δParam is as follows:
[0114] J·δParam=δκ (20)
[0115] For each preset bending direction, each sensing point corresponds to a different central wavelength and surrounding core wavelength. The Jacobian matrix J under k preset bending directions can be calculated by numerical calculation. The parameter error can be expressed as the following formula:
[0116] δParam=inv(J)·δκ (21)
[0117]
[0118] The inv() function in the above formula means to find the inverse matrix of a matrix.
[0119] Combining formulas (17) to (22), the expression (23) for determining the parameters of the corrected target shape is obtained as follows:
[0120]
[0121] Step 608, determining a target wavelength of the flexible device at a target time, and determining a shape of the flexible device at the target time based on the target wavelength, the reference wavelength and the target shape determination parameters.
[0122] In the technical solution provided in step 608, the process of determining the shape of the flexible device at the target time according to the target wavelength, the reference wavelength and the target shape determination parameter is as follows: Fig.13 As shown, it includes: determining the strain of the flexible device at the target moment according to the target wavelength, the reference wavelength and the target shape strain coefficient in the target shape determination parameters, wherein the target wavelength includes the target intermediate core wavelength of the intermediate core and the target peripheral core wavelength of the peripheral core; determining the target curvature and target bending direction angle of each sensing point in the flexible device at the target moment according to the target calibration angle, the target core distance and the target angle offset in the strain and the target shape determination parameters, wherein the target bending direction angle is the angle between the bending direction of the sensing point and the reference direction, and the bending direction is the normal direction of the sensing point; determining the shape of the flexible device at the target moment according to the target curvature and the target bending direction angle of each sensing point at the target moment, and the position information of each sensing point on the flexible device along the arc length direction of the flexible device.
[0123] Optionally, when calculating the shape of the flexible device at the target time, for ease of calculation, θ1 can be set to 0, and the calibration angle θ calib Adding, we can get the following formula:
[0124] ∈ i = -κr cos(θ b -θ calib -(i-1)·Δθ), i=1,2,3 (24)
[0125]
[0126] θ b =ANGLE(κ x ,κ y ) (27)
[0127] It should be noted that the various shape parameters used in the above formulas are all corrected target shape parameters.
[0128] Combining formulas (5), (25) and (26), we can obtain:
[0129]
[0130] As can be seen from the above formula, there are two unknowns in the formula, and two equations are needed to solve κ and θ b Therefore, when the data of the middle fiber core is known, at least two surrounding fiber cores are required. Usually, at least three surrounding fiber cores are set to improve a certain stability. And from formula (28), the relationship between the curvature size and bending direction angle of the flexible device and other parameters can be obtained:
[0131] [κ,θb ]=f(θ calib ,Δθ,r,S ∈ ,λ i,0 ,λ c,0 ,λ i ,λ c )
[0132] In some embodiments of the present application, the complete process of determining the shape of the flexible device is as follows Fig.13 As shown, it includes two parts: calibration part and real-time measurement part. In the calibration part, the initial calibration angle will be calculated based on the linear calibration results, single plane calibration results, and the initial flexible device parameters and true values provided by the manufacturer. Then, the relevant parameters of the flexible device will be corrected according to the multi-directional plane calibration results, the initial calibration angle, and the flexible device parameters and true values provided by the manufacturer. Then, in the real-time measurement step, the shape of the flexible device at the target moment will be reconstructed according to the corrected parameters, where the target moment is any moment in the real-time measurement process. The initial flexible device parameters provided by the manufacturer include the core distance r, the strain coefficient S ∈ , core angle offset Δθ, position s of each sensing point along the arc length direction (the distance between each sensing point along the arc length direction of the flexible device, for example, s = [s1 s2 s3 s4 ...], for example, S1 = 0, s2 = 33 respectively represent the first sensing point at the starting point of the sensing area, and the second sensing point at a position 33 mm away from the starting point). These parameters are related to the grating processing process or the material of the flexible device itself.
[0133] Compared with the flexible device shape determination process in the prior art, the present application additionally performs multi-directional plane calibration during the calibration process, and corrects the relevant parameters of the flexible device based on the calibration results of the multi-directional plane calibration, so that the flexible device shape determination method provided in the present application can determine the shape of the flexible device more accurately than the comparative document.
[0134] In summary, the present application obtains the multi-directional plane calibration results of the flexible instrument, and determines the correlation between the curvature measurement error and the shape determination parameter error of the flexible instrument based on the multi-directional plane calibration results of the flexible instrument, thereby correcting the shape determination parameters of the flexible instrument, and determining the shape of the flexible instrument based on the corrected shape determination parameters, thereby achieving the technical effect of accurately determining the real-time shape of the flexible instrument, and solving the technical problem in the related art that the shape of the flexible instrument cannot be accurately determined due to the different curvature measurement sensitivities of the flexible instrument in different directions when calibrating the flexible instrument. In addition, in the present application, by decomposing the curvature into two directions for identification respectively, the measurement errors of the curvature and bending direction angle measurement results caused by the different measurement sensitivities of the grating in different directions can be further reduced.
[0135] In addition, the flexible device calibration method provided in the embodiment of the present application can be applied in a variety of application scenarios, for example, Fig.14 In the handheld scenario shown, or as Fig.15 In the flexible instrument robot system shown in FIG. When applied to a flexible robot system, such as Fig.16 As shown, flexible instruments such as flexible instruments can be integrated into the flexible arms of the robot.
[0136] Fig.17 A structural block diagram of a flexible device shape determination device provided in an embodiment of this specification, the device comprising:
[0137] A first processing module 170 is used to determine a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multi-directional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multi-directional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device;
[0138] The second processing module 172 is used to determine the correlation between the curvature measurement error of the flexible device and the shape determination parameter error based on the straight line calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameter includes an initial strain factor of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores, and an initial fiber core distance between the surrounding fiber core and the intermediate fiber core, and the initial calibration angle is used to determine the bending direction of each sensing point in the flexible device;
[0139] The third processing module 174 is used to correct the initial shape determination parameters according to the curvature measurement errors of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters;
[0140] The fourth processing module 176 is used to determine the target wavelength of the flexible device at the target time, and determine the shape of the flexible device at the target time according to the target wavelength, the reference wavelength and the target shape determination parameter.
[0141] In some embodiments of the present application, the reference wavelength includes an intermediate core reference wavelength of the intermediate core and a surrounding core reference wavelength of the surrounding cores, the first calibration wavelength includes a first intermediate core calibration wavelength of the intermediate core and a first surrounding core calibration wavelength of the surrounding cores, the second calibration wavelength includes a second intermediate core calibration wavelength of the intermediate core and a second surrounding core calibration wavelength of the surrounding cores, and the target wavelength includes a target intermediate core wavelength of the intermediate core and a target surrounding core wavelength of the surrounding cores.
[0142] In some embodiments of the present application, each preset bending direction corresponds to a rotation direction of the flexible device, and there is a corresponding rotation direction in each quadrant of the preset plane rectangular coordinate system, and the plane where the preset plane rectangular coordinate system is located is a plane perpendicular to the axis of the flexible device.
[0143] In some embodiments of the present application, each sensing point in the flexible device corresponds to an initial calibration angle, and each sensing point corresponds to a grating arranged on the middle fiber core and a plurality of gratings arranged on different surrounding fiber cores, and the initial calibration angle is the angle between the positive direction of the horizontal axis in the rectangular coordinate system of the target plane and any surrounding fiber core, wherein the rectangular coordinate system of the target plane is a coordinate system arranged in the target plane corresponding to the sensing point, and the angle between the surrounding fiber core and the positive direction of the horizontal axis is determined by the following method:
[0144] Connect the coordinate origin of the rectangular coordinate system of the target plane and the center point of the surrounding fiber core in the target plane to obtain a reference line segment with a direction from the coordinate origin to the center point, wherein the center point is the corresponding point of the grating in the surrounding fiber core in the target plane, and the origin is the corresponding point of the grating in the middle fiber core in the target plane; determine that the angle between the reference line segment and the positive direction of the horizontal axis is the angle between the surrounding fiber core and the positive direction of the horizontal axis.
[0145] In some embodiments of the present application, the shape determination parameter error includes the error between the initial shape parameters and the true values of the shape parameters of the flexible instrument, the curvature measurement error includes the error between the curvature measurement value and the true value of the curvature of the flexible instrument, and the straight line calibration result and the plane calibration result are also used to determine the initial calibration angle; the second processing module 172 determines the correlation between the curvature measurement error and the shape determination parameter error of the flexible instrument based on the straight line calibration result, the single-direction plane calibration result, the multi-direction plane calibration result and the initial shape determination parameters of the flexible instrument, and the step includes: determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration result, the multi-direction plane calibration result, the initial shape determination parameters and the true value of the curvature of the flexible instrument.
[0146] In some embodiments of the present application, the true value of curvature includes a horizontal component of the true value of curvature and a vertical component of the true value of curvature; the second processing module 172 determines the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration results, the multi-directional plane calibration results, the initial shape determination parameters and the true value of curvature of the flexible device, and the steps include: determining the curvature measurement value corresponding to each sensing point in the flexible device in each preset bending direction based on the straight line calibration results, the multi-directional plane calibration results, the initial calibration angle and the initial angle offset, wherein the curvature measurement value corresponding to each sensing point in each preset bending direction includes a horizontal component of the curvature measurement value and a vertical component of the curvature measurement value; constructing a Jacobian matrix based on the curvature measurement value corresponding to each sensing point in each preset bending direction and the initial shape determination parameters; determining a parameter error determination formula based on the Jacobian matrix, wherein the parameter error determination formula is used to reflect the curvature measurement error of the flexible device, the correlation between the Jacobian matrix and the shape determination parameter error.
[0147] In some embodiments of the present application, the elements in the Jacobian matrix include: the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial bending direction angle, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial bending direction angle, wherein the initial bending direction angle is the initial value of the angle between the bending direction of the sensing point and the horizontal direction, and the bending direction is the normal direction of the curve at the sensing point; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial fiber core spacing, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial fiber core spacing; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial angle offset, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial angle offset; the calculation results of the partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial strain coefficient, and the calculation results of the partial derivative of the vertical component of the curvature measurement value with respect to the initial strain coefficient.
[0148] In some embodiments of the present application, the fourth processing module 176 determines the shape of the flexible device at the target moment based on the target wavelength, the reference wavelength and the target shape determination parameters, including: determining the strain of the flexible device at the target moment based on the target wavelength, the reference wavelength and the target shape determination parameters in the target shape strain coefficient; determining the target curvature and target bending direction angle of each sensing point in the flexible device at the target moment based on the strain and the target calibration angle, the target core pitch and the target angle offset in the target shape determination parameters, wherein the target bending direction angle is the angle between the bending direction of the sensing point and the reference direction, and the bending direction is the normal direction of the sensing point; determining the shape of the flexible device at the target moment based on the target curvature and target bending direction angle of each sensing point at the target moment, and the position information of each sensing point on the flexible device along the arc length direction of the flexible device.
[0149] According to an embodiment of the present application, a non-volatile storage medium is also provided, in which a computer program is stored. When the computer program is executed by a processor, the following method for determining the shape of a flexible device is implemented: determining a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multi-directional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multi-directional plane calibration result includes a second calibration wavelength corresponding to the flexible device in each preset bending direction; determining parameters of the flexible device based on the linear calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape of the flexible device, The invention discloses a method for determining a correlation between a curvature measurement error and a shape determination parameter error of a flexible device, wherein the flexible device comprises an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameters comprise an initial strain coefficient of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores, and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the correlation relationship to obtain a target shape determination parameter; the target wavelength of the flexible device is determined at the target time, and the shape of the flexible device at the target time is determined according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0150] According to an embodiment of the present application, a computer program product is also provided, including a computer program. When the computer program is executed by a processor, the following method for determining the shape of a flexible device is implemented: determining a straight line calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multi-directional plane calibration result, the straight line calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multi-directional plane calibration result includes a second calibration wavelength corresponding to the flexible device in each preset bending direction; determining parameters based on the straight line calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape of the flexible device, and determining the curvature measurement of the flexible device. The correlation between the error and the shape determination parameter error, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, the initial shape determination parameters include the initial strain coefficient of the flexible device, the initial calibration angle, the initial angle offset between any two adjacent surrounding fiber cores and the initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters; the target wavelength of the flexible device is determined at the target time, and the shape of the flexible device at the target time is determined according to the target wavelength, the reference wavelength and the target shape determination parameters.
[0151] According to an embodiment of the present application, a surgical method is also provided, the method comprising:
[0152] Determine a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device;
[0153] According to the linear calibration results, the unidirectional plane calibration results, the multidirectional plane calibration results and the initial shape determination parameters of the flexible device, the correlation between the curvature measurement error and the shape determination parameter error of the flexible device is determined, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameters include an initial strain factor of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores, and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device;
[0154] The initial shape determination parameters are corrected according to the curvature measurement errors of the flexible device in each preset bending direction and the correlation relationship to obtain the target shape determination parameters; the target wavelength of the flexible device is determined at the target time, and the shape of the flexible device at the target time is determined according to the target wavelength, the reference wavelength and the target shape determination parameters;
[0155] Determining the position information of the end of the flexible device at the target time according to the shape of the flexible device at the target time;
[0156] When the position information indicates that the distal end of the flexible instrument reaches the preset position, the preset surgery is performed.
[0157] See also Fig.18 , is a schematic diagram of the structure of an electronic device provided by an embodiment of the present application. Fig.18 As shown, the electronic device includes: a memory 1801 and a processor 1802 .
[0158] The memory 1801 stores an executable computer program 1803. The processor 1802 coupled to the memory 1801 calls the executable computer program 1803 stored in the memory to execute the flexible instrument shape determination method provided in the above embodiment.
[0159] Exemplarily, the computer program 1803 may be divided into one or more modules / units, which are stored in the memory 1801 and executed by the processor 1802 to complete the present application. The one or more modules / units may include the various modules in the flexible instrument shape determination device in the above-mentioned embodiment, such as: the first processing module 170, the second processing module 172, the third processing module 174 and the fourth processing module 176.
[0160] Furthermore, the apparatus also includes: at least one input device and at least one output device.
[0161] The processor 1802 , memory 1801 , input device and output device may be connected via a bus.
[0162] The input device may specifically be a camera, a touch panel, a physical button or a mouse, etc. The output device may specifically be a display screen.
[0163] Furthermore, the device may include more components than those shown in the figure, or a combination of certain components, or different components, such as a network access device, a grating, etc.
[0164] The processor 1802 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or the processor may be any conventional processor, etc.
[0165] The memory 1801 may be, for example, a hard disk drive memory, a non-volatile memory (such as a flash memory or other electronically programmable memory with limited deletion for forming a solid-state drive, etc.), a volatile memory (such as a static or dynamic random access memory, etc.), etc., and the embodiments of the present application are not limited thereto. Specifically, the memory 1801 may be an internal storage unit of the electronic device, such as a hard disk or memory of the electronic device. The memory 1801 may also be an external storage device of the electronic device, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc. equipped on the electronic device. Furthermore, the memory 1801 may also include both an internal storage unit of the electronic device and an external storage device. The memory 1801 is used to store computer programs and other programs and data required by the terminal. The memory 1801 may also be used to temporarily store data that has been output or is to be output.
[0166] Furthermore, the present application also provides a computer-readable storage medium, which may be disposed in the electronic device in the above embodiments. Fig.18 The memory 1801 in the illustrated embodiment. The computer readable storage medium stores a computer program, and when the program is executed by the processor, the flexible device shape determination method described in the aforementioned embodiments is implemented. Further, the computer storable medium can also be a U disk, a mobile hard disk, a read-only memory (ROM), a RAM, a magnetic disk or an optical disk, etc., which can store program codes.
[0167] In the several embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the modules is only a logical function division. There may be other division methods in actual implementation, such as multiple modules or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or modules, which can be electrical, mechanical or other forms.
[0168] The modules described as separate components may or may not be physically separated, and the components shown as modules may or may not be physical modules, that is, they may be located in one place or distributed on multiple network modules. Some or all of the modules may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0169] In addition, each functional module in each embodiment of the present application can be integrated into a processing module, or each module can exist physically separately, or two or more modules can be integrated into one module. The above integrated modules can be implemented in the form of hardware or software functional modules.
[0170] If the integrated module is implemented in the form of a software function module and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present application is essentially or the part that contributes to the relevant technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a readable storage medium, including a number of instructions to enable a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned readable storage medium includes: various media that can store program codes, such as USB flash drives, mobile hard drives, ROM, RAM, magnetic disks, or optical disks.
[0171] It should be noted that, for the above-mentioned method embodiments, for the sake of simplicity of description, they are all expressed as a series of action combinations, but those skilled in the art should be aware that the present application is not limited by the described action sequence, because according to the present application, certain steps can be performed in other sequences or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by the present application.
[0172] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0173] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example" or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present application. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.
[0174] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit it. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present application.
Claims
1. A method for determining the shape of a flexible device, characterized in that: include: Determine a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device; According to the straight line calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device, the correlation between the curvature measurement error and the shape determination parameter error of the flexible device is determined, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameter includes an initial strain factor of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; According to the curvature measurement errors of the flexible device in each of the preset bending directions and the association relationship, the initial shape determination parameters are corrected to obtain target shape determination parameters; A target wavelength of the flexible device is determined at a target time, and a shape of the flexible device at the target time is determined based on the target wavelength, the reference wavelength and the target shape determination parameter.
2. The method for determining the shape of a flexible device according to claim 1, characterized in that: The shape determination parameter error includes an error between an initial shape parameter and a true value of the shape parameter of the flexible instrument, the curvature measurement error includes an error between a curvature measurement value and a true value of the curvature of the flexible instrument, and the straight line calibration result and the unidirectional plane calibration result are also used to determine the initial calibration angle; based on the straight line calibration result, the unidirectional plane calibration result, the multi-directional plane calibration result and the initial shape determination parameter of the flexible instrument, determining the correlation between the curvature measurement error of the flexible instrument and the shape determination parameter error includes: The correlation between the curvature measurement error and the shape determination parameter error is determined based on the straight line calibration result, the multi-directional plane calibration result, the initial shape determination parameter and the true value of the curvature of the flexible device.
3. The method for determining the shape of a flexible device according to claim 2, characterized in that: The true curvature value includes a horizontal component of the true curvature value and a vertical component of the true curvature value; determining the correlation between the curvature measurement error and the shape determination parameter error based on the straight line calibration result, the multi-directional plane calibration result, the initial shape determination parameter and the true curvature value of the flexible device includes: Determine the curvature measurement value corresponding to each of the sensing points in the flexible device in each of the preset bending directions according to the straight line calibration result, the multi-directional plane calibration result, the initial calibration angle and the initial angle offset, wherein the curvature measurement value corresponding to each of the sensing points in the preset bending directions includes a horizontal component of the curvature measurement value and a vertical component of the curvature measurement value; Constructing a Jacobian matrix according to the curvature measurement value corresponding to each of the sensing points in each of the preset bending directions and the initial shape determination parameters; A parameter error determination formula is determined based on the Jacobian matrix, wherein the parameter error determination formula is used to reflect the curvature measurement error of the flexible instrument, and the Jacobian matrix and the shape determine the correlation between the parameter error.
4. The method for determining the shape of a flexible device according to claim 3, characterized in that: The elements in the Jacobian matrix include: The calculation result of partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial bending direction angle, and the calculation result of partial derivative of the vertical component of the curvature measurement value with respect to the initial bending direction angle, wherein the initial bending direction angle is the initial value of the angle between the bending direction of the sensing point and the horizontal direction, and the bending direction is the normal direction of the curve at the sensing point; The calculation results of partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial fiber core distance, and the calculation results of partial derivative of the vertical component of the curvature measurement value with respect to the initial fiber core distance; The calculation results of partial derivative of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial angle offset, and the calculation results of partial derivative of the vertical component of the curvature measurement value with respect to the initial angle offset; The calculation results of partial derivatives of the horizontal component of the curvature measurement value corresponding to each sensing point in each preset bending direction with respect to the initial strain coefficient, and the calculation results of partial derivatives of the vertical component of the curvature measurement value with respect to the initial strain coefficient.
5. The method for determining the shape of a flexible device according to claim 1, characterized in that: The reference wavelength includes an intermediate core reference wavelength of the intermediate core and a surrounding core reference wavelength of the surrounding cores, the first calibration wavelength includes a first intermediate core calibration wavelength of the intermediate core and a first surrounding core calibration wavelength of the surrounding cores, the second calibration wavelength includes a second intermediate core calibration wavelength of the intermediate core and a second surrounding core calibration wavelength of the surrounding cores, and the target wavelength includes a target intermediate core wavelength of the intermediate core and a target surrounding core wavelength of the surrounding cores.
6. The method for determining the shape of a flexible device according to claim 1, characterized in that: Each of the preset bending directions corresponds to a rotation direction of the flexible device, and each quadrant of a preset plane rectangular coordinate system has a corresponding rotation direction, and the plane where the preset plane rectangular coordinate system is located is a plane perpendicular to the axial direction of the flexible device.
7. The method for determining the shape of a flexible device according to claim 1, characterized in that: Each sensing point in the flexible device corresponds to an initial calibration angle, and each sensing point corresponds to a grating arranged on the intermediate fiber core and a plurality of gratings respectively arranged on different surrounding fiber cores, and each grating corresponding to the same sensing point is in the same target plane, and the initial calibration angle is the angle between the positive direction of the horizontal axis in the rectangular coordinate system of the target plane and any of the surrounding fiber cores, wherein the rectangular coordinate system of the target plane is a coordinate system arranged in the target plane corresponding to the sensing point, and the angle between the surrounding fiber core and the positive direction of the horizontal axis is determined by the following method: Connecting the coordinate origin of the rectangular coordinate system of the target plane and the center point of the surrounding fiber core in the target plane to obtain a reference line segment whose direction is from the coordinate origin to the center point, wherein the center point is the corresponding point of the grating in the surrounding fiber core in the target plane, and the origin is the corresponding point of the grating of the intermediate fiber core in the target plane; The angle between the reference line segment and the positive direction of the horizontal axis is determined to be the angle between the surrounding fiber core and the positive direction of the horizontal axis.
8. A flexible instrument shape determination system, characterized in that: It includes a calibration module and a real-time measurement module, among which: The calibration module is used to determine the linear calibration result and the plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device; the curve of the flexible device is determined based on the linear calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameters of the flexible device. The correlation relationship between the curvature measurement error and the shape determination parameter error is determined, wherein the flexible device includes an intermediate fiber core and multiple surrounding fiber cores, and the initial shape determination parameters include an initial strain coefficient of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores, and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; the initial shape determination parameters are corrected according to the curvature measurement error of the flexible device in each preset bending direction and the correlation relationship to obtain target shape determination parameters; The real-time measurement module is used to determine the target wavelength of the flexible device at a target time, and determine the shape of the flexible device at the target time based on the target wavelength, the reference wavelength and the target shape determination parameter.
9. A flexible device shape determination transposition, characterized in that: include: A first processing module, used to determine a linear calibration result and a plane calibration result of the flexible device, wherein the plane calibration result includes a unidirectional plane calibration result and a multidirectional plane calibration result, the linear calibration result includes a reference wavelength of the flexible device, the unidirectional plane calibration result includes a first calibration wavelength of the flexible device, and the multidirectional plane calibration result includes a second calibration wavelength corresponding to each preset bending direction of the flexible device; a second processing module, for determining the correlation between the curvature measurement error and the shape determination parameter error of the flexible device according to the straight line calibration result, the unidirectional plane calibration result, the multidirectional plane calibration result and the initial shape determination parameter of the flexible device, wherein the flexible device comprises an intermediate fiber core and a plurality of surrounding fiber cores, the initial shape determination parameter comprises an initial strain factor of the flexible device, an initial calibration angle, an initial angle offset between any two adjacent surrounding fiber cores and an initial fiber core distance between the surrounding fiber cores and the intermediate fiber core, and the initial calibration angle is used to determine the degree of torsion of each sensing point in the flexible device; A third processing module is used to correct the initial shape determination parameters according to the curvature measurement errors of the flexible device in each preset bending direction and the association relationship to obtain target shape determination parameters; The fourth processing module is used to determine the target wavelength of the flexible device at the target time, and determine the shape of the flexible device at the target time according to the target wavelength, the reference wavelength and the target shape determination parameter.
10. A non-volatile storage medium storing a computer program, wherein the computer program implements the method according to any one of claims 1 to 7 when executed by a processor.
11. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the method according to any one of claims 1 to 7 is implemented.
12. A computer program product comprising a computer program, which, when executed by a processor, implements the method according to any one of claims 1 to 7.
