SE1550059A1

SE1550059A1 - Sensor and method enabling the determination of the position and orientation of a flexible element

Info

Publication number: SE1550059A1
Application number: SE1550059A
Authority: SE
Inventors: Salomonsson Niklas
Original assignee: Salomonsson Niklas
Priority date: 2015-01-22
Filing date: 2015-01-22
Publication date: 2016-07-23
Also published as: US10260913B2; SE538575C2; EP3247975B1; US20170350733A1; EP3247975A4; EP3247975A1; WO2016118070A1

Description

15 procedure is however inherently dependent upon the background and will significantly reduce the possible environments where the robot can be successfully used.

The bend of a flexible robotic limb can be determined using bend resistors, where the resistor is fastened on the limbs. Bend resistors exists today in the form of resistive sensors that change the resistance of the device when bent. The resistance is proportional to the bend and can thus be used to estimate the bend of the sensor or the force that is applied to the sensor if other specifications of the sensor are given. One example of this is the Tactilus® Flex by SENSOR PRODUCTS INC.

One approach of estimating the bend in a structure element using at least three strain sensors positioned around the structure is disclosed in Ref. 5. The lengthening and shortening of the structure at a specific position where a strain sensor is present can be measured. By using multiple strain sensors the bend of the structure can be estimated. This approach utilizes Bragg-gratlngs to obtain the estimate. ln Ref 6, there is proposed a sensor for determining the bend of a number of optical fibers bundled together. The optical fibers form part of a colonoscopy camera and are provided with holes on their surface. A measurement of the intensity of light emítted through the optical fibers is compared to an initial intensity level. lf the fibers are benta certain amount of light will escape through the holes and thus leading to a difference in detected intensity contra the emitted intensity. The fact that the optical fibers are bundled together will however negatively affect the precision of the measurements needed to be able to determine the position of a flexible large body subject to substantial forces and torques.

Multi-tubular continuum robotic limbs have been used in robotic applications where weight and material use may be an issue. Generally, the tubes are fastened in solid sectional dividing frames. A multi sectional approach can be used where each sectional divider can be considered a frame. Estimation of the dynamic transformation of each pair of bases is done using modeling in combination with sensor readings and a priori knowledge of external forces. From the dynamic transformation and information about the tubular structure 3D positioning of the end 2 10 effector and other parts can be made. This proposal however relies upon the a priori knowledge of the applied forces and are therefore somewhat lacking in respect of the precision that is needed to obtain an accurate positioning of robotic limbs. lt is a purpose of the proposed technology to provide alternative methods and apparatuses for the positioning a flexible element such as a robotic limb. This technology aims to at least alleviate the problems within the technical field and at the same time provide accurate positioning of extended flexible elements subject to forces and torques.

SUMMARY It is an object to provide a sensor that improve the possibilities to determine the position and/or the orientation of a flexible element that is subject to forces and/or torques.

According to a first aspect, there is provided a sensor for enabling positioning of a flexible element subject to applied forces, the sensor comprises: ° at least two spatially separated light permeable tubes, each tube having a first end arranged on a first frame portion and a second end arranged on a second frame portion of the flexible element, wherein at least one of the first end and the second end of at least one light permeable tube are attached to a corresponding frame portion by means of a spherical bearing. The at least two spatially separated light permeable tubes further comprises, - at least one light detecting device, connectable to a processing unit, and arranged at a light detecting position for a corresponding light permeable tube and configured to detect light emitted from at least one light emitting device through the corresponding light permeable tube and configured to transfer information comprising information relating to the detected light to the processing unit to enable 30 the processing unit to determine the bend of the light permeable tube.

According to a second aspect of the proposed technology there is provided a flexible element comprising a sensor according to the first aspect. The flexible element might for example be a flexible robotic limb.

A third aspect of the proposed technology involves a method that enables a determination of the position and/or orientation of a moving frame portion of a sensor subject to forces and/or torques, the method comprises the steps of: - obtaining values representing the detected light intensities for light having propagated through different light permeable tubes; - converting the values of the detected light intensities to length values corresponding to particular distances between the moving frame portion and a frame portion fixed relative said moving frame portion; ~ determining the position and/or the orientation of the moving frame portion relative the fixed frame portion based on the length values.

According to a fourth aspect of the proposed technology there is provided a computer program comprises instructions, which when executed by at least one processor, cause the processor(s) to: - read the values representing the detected light intensities for light having propagated through different light permeable tubes; - convert the values of the detected light intensities to length values corresponding to particular distances between the moving frame portion and a frame portion fixed relative the moving frame portion; - determine the position and/or the orientation of the moving frame portion relative the fixed frame portion based on the length values.

According to a fifth aspect there is provided a computer program product comprising the computer program of the fifth aspect.

An advantage of the proposed technology is that it enables an efficient way of determining the position and/or the orientation of a flexible element that is subject to applied forces and/or torques. There is in particular provided a robust sensor that provides highly accurate measurements that enables a highly accurate 4 determination of the positioning and/or orientation of a flexible element comprising the sensor. Further advantages will be clear from the detailed description.

BRIEF DESCRIPTION OF THE DRAWINGS The embodiments, together with further objects and advantages thereof, may best be understood by making reference to the following description taken together with the accompanying drawings, in which: FIG. 1 is a flow diagram illustrating a method according to the proposed technology.

FIG. 2a is a schematic illustration of a sensor according to the proposed technology.

FIG. 2b is a schematic illustration of a sensor according to the proposed technology.

FIG. 3a is a schematic illustration of a sensor according to the proposed technology.

FIG. 4a is a schematic illustration of a sensor according to the proposed technology.

FIG. 4b is a schematic illustration of a sensor according to the proposed technology.

FIG. 4c is a schematic illustration of an embodiment of a sensor according to the proposed technology.

FIG. 5 is a schematic illustration of an embodiment of a sensor according to the proposed technology.

FIG. 6 is a schematic illustration of an embodiment of a sensor according to the proposed technology.

FIG. 7 is a schematic illustration of an embodiment of a sensor according to the proposed technology.

FIG. 8 is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 9 is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 10a is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 10b is an alternative illustration of the embodiment of sensor according to FIG.10a.

FIG. 11a is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 11b is an alternative illustration of the embodiment of sensor according to FlG.11a.

FIG. 12 is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 13 is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 14 is a schematic illustration of an embodiment of sensor according to the proposed technology.

FIG. 15 is a schematic illustration of an embodiment of sensor according to the proposed technology.

DETAILED DESCRIPTION Throughout the drawings, the same reference designations are used for similar or corresponding elements.

For a better understanding of the proposed technology, it may be useful to begin with a brief overview of how a sensor according to the proposed technology may be used to position dynamically changing flexible elements. The positioning relies on the features of a sensor design that is schematically shown in FIG.1. The sensor design makes use of certain optical characteristics of light to provide a measure of the forces and torques that are applied to the sensor.

To this end the sensor is provided with a number of spatially separated light permeable tubes whose end portions are attached to first and second frame portions, respectively. During regular use of the sensor, forces will either be applied directly on the frame portions or applied indirectly on the frame portions in those cases when the frame portions are embedded in an outer structure. The applied forces will have the effect that the light permeable tubes attached to the frame portions will be bent if the initial configuration was straight or straightened if the initial configuration was bent. To provide for a positioning of the flexible element/robotic 6 15 limb even after applied forces the sensor has to be able to determine the bend of the tubes. To achieve this purpose light is used. That is, light from one or more light sources is emitted into each of the light permeable tubes through a first end of the tube. This light is allowed to propagate in the tubes all the way to specified light detection positions. ln these light detection positions the light is detected and certain light light Characteristics are then processed to obtain a measure of the bend of each of the Characteristics, such as intensity, is extracted. The extracted light permeable tubes. Since light propagates and is detected in all of the individual tubes and since these tubes are spatially separated and thus independently bent one obtain a high quality measure of the bend of each individual tube. Once the bends of the individual tubes has been determined, further method steps, to be described in detail in what follows, are used to obtain a positioning and orientation of the frame portions relative their initial positions. ln a slightly more detailed exposure, the necessary measurements providing the possibility to position a flexible element such as a robotic limb can be obtained by providing a common light emitting source for all light permeable tubes or by providing each single light permeable tube with a light emitting diode, LED, or some other light emitting source. The light emitting source(s) is configured to emit light into each tube. To power the light emitting sources one might connect them to some voltage source, such as a battery, and suitable resistors. Now while the light emitting source(s) emits light through the tube(s) each of the light permeable tubes in the sensor is also provided with light detectors that is configured to measures the light intensity in some other chosen position of the tube(s). These light detecting devices could, for example, be photo diodes or photo transistors, and they are configured to detect the amount of photons that reaches the detectors which will provide an estimate of the intensity of the light at the position of the light detectors. The amount or number of photons that reaches the detector in a single tube is dependent on the bend of the tube as the tube, when bent, will absorb some of the photons hitting the inner surface. Generally, the higher the bend the higher the absorption of the tubes surface will be, and it is therefore possible to estimate the bending degree of the tube(s) by using information about the tubes inner surface, the strength of the light emitting source and the light detectors reading. 7 10 Having described the technology in broad terms above we will now continue to describe various detailed embodiments of the technology.

The proposed technology relates to a sensor that enables the positioning of a flexible element, for example, a robotic limb. The sensor as such can however be used in other applications where a positioning of certain elements subject to forces and torques are requested. The features of the sensor do not depend on the specific application. lt is rather a device that provides highly accurate positioning of dynamically changing flexible elements and can thus find a multitude of applications beyond the realm of robotics. ln this description it will however be used in relation to the positioning of a robotic limb. ln FIG. 2b there is schematically shown the structure of the light permeable tubes comprised in a sensor according to the present disclosure. ln FIG. 2b there is shown how the end portions of three light permeable tubes 1, 10, 100 are attached to frame portions 11a and 11b.

With reference to FIG. 2b, there is shown an example of a sensor that enables a positioning of a robotic limb comprising the sensor. The sensor comprises however at least two spatially separated light permeable tubes 1, 10 having a first end ta, 10a arranged on a first frame portion 11a and a second end 1b, 10b arranged on a second frame portion 11b of the robotic limb. The sensor also comprises a light detecting device 3, that can be connected to a processing unit 4 and that is arranged at a light detecting position of each of the light permeable tubes and that is configured to detect light emitted from a light emitting device 2 through the at least two light permeable tubes 1, 10 and also configured to transfer information comprising information relating to Characteristics of the detected light to the processing unit 4.

With the term spatially separated above is meant that the light permeable tubes are uncoupled, that is, not bound to each other over at least large parts of their lengths.

This is to ascertain that the result of measurements relating to a specific tube is independent of the result of the measurement of other tubes. ln other words, each 8 light permeable tube provides for an independent degree of freedom when it comes to measurements and will as such provide unique information that can be processed to enable the positioning of a flexible element such as a robotic limb. The term light permeable tubes means that the light are allowed to propagate along the tubes from an inlet arranged at the first end ia, 10a, to an outlet arranged at the second end 1b, 10b. The tubes could in certain embodiments be prepared in such a way that most of the light that hits the inside surface of the tube is reflected back towards the bulk of the tube.

The frame portions 11a and 11b that constitutes the bases on which the light permeable tubes are attached are also the structures where the forces are applied.

Directly on the frame portions for those cases where the sensor is free and indirectly when the sensor is embedded in an outer structure such as a flexible element, i.e. a robotic limb. ln the latter case the applied force will be transferred on to the frame portion via the outer structure and should therefore be attached to the flexible element in a way that transfers the force as easy as possible. The sensor utilizes light permeable tubes. With the term light permeable tube is intended tubes whose interior allows light to propagate more or less freely. These tubes could, for example, be hollow tubes but they may also be more elaborate constructions such as optical fibers. The important feature of the tubes is however that they should allow light to propagate largely undisturbed within its interior. The tubes are preferably made of a flexible material, and they could be made out of light weighted carbon fibers or optical fibers being strengthened by an outer layer of a light-weight material such as carbon fiber. ln yet another exemplary embodiment the tubes could be provided with electrically conducting means that allows current to be fed between the frame portions. They could also be partially provided with such means to provide for the possibility that current can be conducted along at least parts of the surface of the tubes. Examples of such means are electrically conducting stripes or electrically conducting material embedded in the material of the outer layer of the tubes. The purpose of such an embodiment is that it provides a way to utilize a sensor within, for example, a robotic limb as both a sensor and as a current conductor. ln this way the amount of wires and cables carrying currents can be reduced. This provides for the possibility of a more light-weighted robotic limb. 9 ln appendix 1 and 2 there is provided an outline of how the detected light Characteristics may be used to enable the positioning of a flexible element. ln what follows there will be described a number of different embodiments of the general sensor described above.

According to a particular embodiment of the proposed technology there is provided a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: ~ at least two spatially separated light permeable tubes 1, 10 each having a first end 1a, 10a arranged on a first frame portion 11a and a second end 'ib, 10b arranged on a second frame portion 11b of the flexible element, and wherein each of the at least two spatially separated light permeable tubes comprises, ° a light emitting device 2, - a light detecting device 3, connectable to a processing unit 4, and arranged at a light detecting position of each of the light permeable tubes and configured to detect light emitted from the light emitting device 2 through each of the at least two light permeable tubes 1, 10 and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10 - a reference detector 30, arranged in the vicinity of the light emitting device 2, the reference detector is configured to detect light emitted from the light emitting device before the light has entered the light permeable tubes to thereby obtain a reference measure of the light characteristics, the reference detector is also configured to transfer information about the obtained measure to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10. This particular example of an embodiment is shown in FlG.3a.

By providing the sensor with a reference detector 30 it will be possible to ensure that certain initial light characteristics that are used for determining the bend of the light permeable tubes are given correct values. lf, for example, light intensity is used as the light characteristic that enables the tube bends to be determined than, since the 10 quantum efficiency of a light emitting diode depends on temperature, the initial light intensity may need to be adjusted in order to obtain a more accurate determination of the bend. This embodiment ensures that the input to the processing unit represents the actual light intensity of the light that is emitted through each of the at least two light permeable tubes 1, 10. A possible way to provide the reference detector with light is by utilizing a beam splitter arranged between the light emitting device(s) or light emitting source(s) and the tubes. Light emitted from a particular source will thereby be split into two beams, one propagating through the tube and the other being directed towards the reference detector 30.

According to another embodiment of the proposed technology there is provided a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: ~ at least two spatially separated light permeable tubes 1, 10 each having a first end 1a, 10a arranged on a first frame portion 11a and a second end 1b, 10b arranged on a second frame portion 11b of the flexible element, and wherein each of the at least two spatially separated light permeable tubes comprises, ~ a plurality of light emitting devices 2, 22, 222, each configured to emit light of a specified wavelength through the corresponding light permeable tube, ° a plurality of light detecting devices 3, 33, 333 arranged at a light detecting position and being connectable to a processing unit 4, each of the light detecting devices 3, 33, 333 being configured to detect light of a specified wavelength emitted from a corresponding light emitting device 2, 22, 222, each of the light detecting devices 3, 33, 333 is further configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10. This particular example of an embodiment is schematically shown in FlG.3b. ln FlG.3b there is also shown three references detectors 30, 350, 355 each of the reference detectors being configured to detect light from a particular light emitting device to provide reference values for the emitted light. The reference detectors 30, 350 and 355 are optional in this embodiment. 11 By providing several light emitting sources, or equivalently several light emitting devices, and corresponding light detecting devices that are tuned to emit and detect, respectively, light of a certain wavelength the sensor will be able to provide a more robust output. Moreover the inclusion of several light emitting sources and light emitting devices provide better redundancy is those cases where one of light emitting devices and/or one of the light detecting devices becomes non-operative, e.g. gets broken. ln a particular embodiment it is possible to provide the processing unit 4 with instructions to perform an algorithm whereby the outputs from the different light detecting devices 3, 33, 333 are compared and the most viable is used to determine the bend of the light permeable tubes 1, 10. ln a possible embodiment the number of light emitting devices 2, 22, 222 and corresponding light detecting devices 3, 33, 333 may moreover be an odd number larger than or equal three. ln this way it will be possible to provide the processing unit 4 with instructions to perform an algorithm whereby the outputs from the different light detecting devices 3, 33, 333 are compared and voting is performed to provide the most probable estimation of the bend of the light permeable tubes 1, 10. This comparison algorithm might in a particular case be based on a voting functionality whereby the most appropriate value is extracted from the several outputs of the various light emitting devices by means of a majority vote. This could for example be performed by means of a Field Programmable Gate Array, FPGA. A particular embodiment of the proposed technology comprising three light emitting devices 2, 22, 222 and corresponding light detecting devices 3, 33, 333 is shown in FIG. 3b.

A possible embodiment of a sensor comprising a plurality of light emitting devices 2, 22, 222 also comprises a beam splitter arranged between at least a subset of the light emitting devices 2, 2, 222 and a particular tube. The beam splitter is configured to collimate beams of light emitted from different light emitting devices and direct them towards a particular tube. lt will in this way be possible to provide a single tube with light emitted from several different light emitting devices, by having corresponding detectors that detects Characteristics of the light that has propagated through the tube, a single tube with beam splitter will therefor provide more information than a tube provided with light from a single source. The embodiment might also comprise beam splitters for the corresponding light detecting devices 3, 12 15 30 33, 333. That is, beam splitters are provided between the outlet of the tube and the light detecting devices 3, 33, 333 The light emitting devices 2, 22,222 which might be regular light emitting diodes, could either be provided externally from the sensor or could be integrated into the sensor. ln the case where they are arranged externally from the sensor they should be arranged on an outer element so that they can emit light into the light permeable tubes 1. Such an outer element could for example be the main robot body if the sensor is either incorporated in a robotic limb or if the sensor with its frame portions constitutes a robotic limb. All of the light permeable tubes could be provided with their own light emitting devices 2 dedicated to emit light through their allocated light permeable tube. lt could however also be a single set of light emitting devices that are allocated to multiple light permeable tubes.

Still another embodiment of the proposed technology provides a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: ~ at least two spatially separated light permeable tubes 1, 10 each having a first end 1a, 10a arranged on a first frame portion 11a and a second end 1b, 10b arranged on a second frame portion 11b of the flexible element, and wherein each of the at least two spatially separated light permeable tubes comprises, ° a light emitting device 2 arranged at one end of the light permeable tube and configured to emit light through the corresponding light permeable tube; - a light detecting device 3, connectable to a processing unit 4, and arranged at a light detecting position of the light permeable tube and configured to detect light emitted from light emitting device 2, and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10, ~ a diffusion filter 45 arranged between the light emitting device 2 and the light permeable tubes. A particular example of an embodiment of such a sensor is schematically shown in FlG.4a. 13 An alternative embodiment is shown in F|G.4B, here two diffusion filters 45 are provided between the light emitting device and a tube. Having two or more filters arranged in succession renders the light even more By providing a diffusion filter between the light emitting device(s) and the light detecting device it provides for a means whereby the light emanating from the light emitting sources enters the at least two spatially separated light permeable tubes 1, 10 in a more isotropic fashion. Consider light emitted from a light emitting device 2 into a light permeable tube, initially the light propagates towards the tube with a rather narrow Gaussian, by providing a diffusion filter the variance of the Gaussian gets enhanced and the noise gets reduced, hence the light that enters the tube has a broader Gaussian shape. This in turn ensures that the light that enters the tube is more isotropic. This in particular reduces the risk that the detected light displays Characteristics that are dependent on collimated light features. A particular embodiment of the proposed technology is illustrated in F|G.W, here there is only shown a single light emitting device 3 and a diffusion filter 46 arranged between the light emitting device 3 and a single light permeable tube. This might however be generalized so that there is any number of light permeable tubes together with any number of light emitting devices, it could for example be a single, or only a few, light emitting device(s) for any number of tubes or as many light emitting devices as there are tubes or any other possible combination. On the same token, there can be provided any number of diffusion filters, for example one filter applied to all light emitting devices, or a filter per light emitting device or any possible variation. The only thing that is important is that the filter renders the light emitted into the tubes more isotropic.

An alternative embodiment is shown in F|G.4B, here two diffusion filters 45 are provided between the light emitting device and a tube. Having two or more filters arranged in succession renders the light that enters the tubes even more isotropic.

Another version of a sensor might also be provided with diffusion filters arranged on the light detecting side of the tubes. ln this way there is provided a sensor where the 15 outgoing light passes through a diffusion filter before it is detected by the light detecting device. This will ensure that the detected light is isotropic when detected Yet another embodiment of the proposed technology provides a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: - at least two spatially separated light permeable tubes 1, 10 each having a first end 1a, 10a arranged on a first frame portion 11a and a second end 1b, 'IOb arranged on a second frame portion 11b of the flexible element, and wherein each of the at least two spatially separated light permeable tubes comprises, - a light detecting device 3 in the form of an array of photodiodes 31, connectable to a processing unit 4, and arranged at a light detecting position of each of the at least two light permeable tubes and configured to detect light emitted from a light emitting device 2 emitting laser light through each of the at least two light permeable tubes 1, 10 and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10. An embodiment of such a sensor is shown in FlG.4c.

By providing an array of photo diodes 31 as the light detecting device together with a light emitting source in the form of a laser, the proposed sensor provides a way whereby the bend of the tubes 1, 10 can be obtained by utilizing the detected light in each particular array element of the photodetector array. One embodiment of the array of the photodetectors comprises a linear array where a number of photodetectors are arranged along a line. Another embodiment relates to a case where the array is a two dimensional array whose surface is facing the end section of the corresponding tube. ln other words, the two dimensional array comprises a number of photodetectors arranged in a matrix facing the end section of the corresponding tube. ln a particular example could this array of photodetectors be a quadrant photodiode. By detecting light intensities on the different quadrants it will it be possible to determine the most probable configuration of the tubes. lf, for example, the upper quadrants detects a substantially larger amount of light it is highly likely that the tube has been bent downwards relative the quadrant photodiode. The use of a light emitting source in the form of a laser facilitates the 15 use of a quadrant photodiode since the laser is not substantially effected by the inside surfaces of the tubes. This particular embodiment therefore provides a way to obtain more explicit, or fine grained, information about the light emitted through the tubes. This fine grained information that is extracted by means of the exposure of light on the various array elements in the photo diode array 31 will in turn enhance the precision with which the bend of the tubes can be determined. lt may in particular reduce the number of light permeable tubes used in the sensor.

A potential variation of a sensor that is able to provide a positioning of a flexible element comprises a sensor where a particular position of the tubes is provided with a glass element that at least partially covers the cross-section of the tube.

Depending on the degree of bending of the tube this glass element will reflect different amounts of light, thereby providing a mechanism whereby the detected light intensity depends on the degree of bending of the tubes.

Still another embodiment of the proposed technology provides a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: - at least two spatially separated light permeable tubes 1, 10 each having a first end 1a, 10a arranged on a first frame portion 11a and a second end 1b, 10b arranged on a second frame portion 11b of the flexible element, wherein at least one of the first end 1a, 10a and second end 1b, 10b are attached to the corresponding first frame portion 11a and second frame portions 11b by a joining means 120, and wherein each of the at least two spatially separated light permeable tubes comprises, - at least one light detectíng device 3, connectable to a processing unit 4, and arranged at a light detectíng position of each of the light permeable tubes and configured to detect light emitted from at least one light emitting device 2 through each of the at least two light permeable tubes 1, 10 and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1, 10. A schematic illustration of such a sensor is provided by FIG.5.

The joining means 120 should be preferably be of a type that allows the tubes to move or bend in a direction that is transversal to the frame portion containing the 16 15 attachment point or attachment section. That is, if a tube are attached to a frame at a specific point then the joining means should provide for the possibility for the tube to be translationally fixed in the frame portion but allowed to rotate around its attachment point. The joining means 120 may for example be a joining means such as a spherical bearing or a universal joint. The use ofjoining means as a mechanism for attaching or fastening the tubes to the frame portions enables a highly efficient positioning of the flexible elements. This is related to the fact that when the sensor is provided with such joining means as spherical bearings, or equivalently spherical plain bearings or universal joints, the curvature of the tube between the fastening points take the shape of a half sine wave in some direction, at least for most realistic cases. The amplitude of the sine wave is inversely proportional to the length between the points. As the tubes attenuation is proportional to the bend of the tubes, the intensity readings will therefore be proportional to the length between the fastening points. Hence these joining means enables a more simplified determination of the bend of the tubes since it imposes that the shape of the tubes, when a force or torque has been applied to the frame portion to which the tubes are attached, take the form of a half sine wave. A detected light intensity thereby provide a proper measure of the distance between the two frame portions. This is schematically illustrated in FlG.6 where a force has been applied to one of the frame portions 11 a or 11b. The force has forced the frame portions closer to each other and the tube 10 has acquired a curvature or bend. Since the tube 10 are attached to the frame portions by means ofjoining means 120, such as a spherical bearings, the shape of the curvature takes the form of a half sine wave. A detection of the intensity of light having propagated through the tube 10 can thus be used to obtain a distance between two points on the tube, for example Px and Py in the figure, or the distance between the frame portions 11a and 11b. The distance between the frame portions 11a and 11b can then be used to position a flexible element that comprises the frame portions 11a and 11b. lt can moreover be used to provide an orientation of a frame portion relative the other. This will be described more in what follows.

A particular embodiment of a sensor comprising joining means 120 relates to a sensor where one of the frame portions 11a are fixed and the other frame portion 11b is allowed to rotate. lf the end point of a tube 1 is attached to frame portion 11a 17 in a fixed manner and the tube 1 is attached to the frame 11b by a joining means 120 that allows the end of the tube to rotate around its point of attachment, then a rotation of the frame portion 11b will lead to a torsion of the tube. This embodiment can be used to obtain a measure of the torsion. The joining means 120 may in this example be a universal joint. On the other hand, for this particular case, if the joining means 120 attaching tube 1 to frame portion 11b is a spherical bearing, there will be no torsion. lt may therefore be seen that one can provide the sensor with different joining means 120 whereby different ends of the tubes can be attached to their corresponding frame portions by different joining means 120, such as a spherical bearing at one end and a universal joint at the other. The different purposes of the sensor dictating what configuration to use.

Another advantage with this particular embodiment is that it also counters potential skewing effects on the tubes which make the sensor more accurate since skewing effects might affect characteristics of light that propagates through a tube that has been skewed by applied forces or torques.

This advantageous effect can be obtained by using a joining means 120 such as a spherical bearing, a cardan joint or a universal joint. The tubes will therefore be attached to the frames by these joining means.

According to a particular embodiment, one of the ends of one light permeable tubes, say tube 1, may be attached to a corresponding frame by means of such joining means 120.

Another embodiment provides a sensor where each end of at least one tube 1, 10 are attached to the corresponding frame portion 11a, 11b by means ofjoining means 120.

A particular embodiment provides a sensor where the joining means 120 comprises a spherical bearing or a universal joint. 18 Still another embodiment provides a sensor where one end of at least one tube 1, 10 are attached to one frame portion by means of a spherical bearing and the other end of the at least one tube 1, 10 are attached to the other frame portion by means of a universal joint.

Another embodiment is obtained by attaching all ends of all light permeable tubes by means of joining means 120. This is schematically shown in F|G.5 for the case of two light permeable tubes 1, 10. The joining means may differ from one end to another, for example a spherical bearing at one end and a universal joint at the other.

Yet another embodiment of the proposed technology provides a sensor for enabling positioning of a flexible element subject to applied forces. The sensor comprises: - six spatially separated light permeable tubes 1, each tube having a first end 1a, arranged on a first frame portion 11a and a second end 1b arranged on a second frame portion 11b of the flexible element, and wherein each of the six spatially separated light permeable tubes comprises, - a light detecting device 3, connectable to a processing unit 4, and arranged at a light detecting position of each of the light permeable tubes and configured to detect light emitted from a light emitting device 2 emitting light through the light permeable tubes and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes. A sensor provided with six light permeable tubes are schematically illustrated in FlGs 7-9. ln one particular embodiment each of the six spatially separated light tubes is equipped with its own set of light detecting devices 3 and light emitting devices 2.

That is, a single tube in the set of tubes may be provided with a plurality of light emitting devices 2, 22, 222 and corresponding light detecting devices. Moreover, each of the six spatially separated tubes may also be provided with either one or a set of reference detectors 45 for each light emitting device. Still another embodiment comprises a sensor provided with A diffusion filter 45.

Many different configurations are possible for a sensor that comprises six light permeable tubes. Two especially useful planar configurations comprises six light permeable tubes wherein the fastening points of six light permeable tubes on one frame portion 11a are arranged to correspond to either the vertices of a triangle 124 5 or the vertices of a hexagon 123, and the fastening points of six light permeable tubes on the other frame portion 11b to either the vertices of a triangle 124 or the vertices of a hexagon 123 or a combination of them, see figures 7, and 8. The sides of the hexagon and triangle does not necessary have to be equal. Such a fastening pattern simplifies the computations needed to position the flexible element. Many 10 other setups are however possible besides these. lt should also be noted that at least one frame portion might be a modular frame portion where different modular sections acts as fastening structures for different sets of light permeable tubes, this is shown schematically in FIG 9. 15 A sensor comprising six tubes are particularly useful for a method, to be described below, that enables the determination of the orientation of a flexible element by utilizing detected light Characteristics obtained by such a sensor. The flexible element being one of the frame portions 11a or 11b. 20 lt should be noted that the particular features of all the described embodiments can be combined to provide a sensor that comprises all of the described features or any combination of the described features. Since the described features are mutually compatible it will be possible to provide a sensor comprising any combination of the features described above. ln particular, different part solutions in the different 25 embodiments can be combined in other configurations, where such configurations are technically possible.

As a first example it may be possible to provide a sensor comprising joining means 120 as described earlier with a light emitting device 3 that comprises a plurality of 30 light emitting diodes, where each light emitting diode is conflgured to emit light of a pre-determined wavelength. 20 As a second example, a sensor comprising joining means 120 as described earlier might also comprise a reference detector 30 arranged in the vicinity of the light emitting device and being configured to detect light emitted from the light emitting device before the light enters the light permeable tubes 1, 10 to obtain reference values for certain light characteristics of the emitted light.

Still another example of an embodiment provides a sensor having joining means 120 and also a beam-splitter arranged between a light emitting device 3 and a light permeable tube. The beam-splitter being configured to direct part of the light emitted from the light emitting device 3 to the reference detector 30.

Yet another sensor comprising joining means 120 might comprise a diffusion filter () arranged between the light emitting device 3 and the light permeable tube 1.

Moreover the sensor having joining means might be provided with six spatially separated light permeable tubes 1, 10.

Yet another version of a sensor comprising joining means 120 relates to a sensor where the number of light detecting devices 3 and light emitting devices 2 corresponds to the number of light permeable tubes and wherein each of the light detecting devices 3 and the light emitting devices are used for a designated light permeable tube 1, 10.

Still another version of a sensor provided with joining means provide a sensor where the light emitting device 2 comprises a laser and where the light detecting device 3 comprises an array of light detecting devices 3.

The proposed technology also provides a flexible element comprising a sensor according to the described embodiments. This flexible element might be a robotic limb that comprises the sensor. Still another embodiment, relevant for all earlier described embodiments, provides a flexible element that also comprises a protective casing. FIG. 10a provides a schematic illustration of such a flexible element. The particular feature of a protective casing can be combined with all the earlier 21 described embodiments. FIG. 10a discloses a flexible element comprising a sensor that comprises two light permeable tubes 1, 10 having their ends attached to frame portions 11a and 11b. The flexible element comprising the sensor are partially enclosed in a protective casing 65. The frame portions 11a and 11b of the sensor comprised in the flexible element should not be enclosed by the protective casing since they are supposed to be subjected to externally applied forces and torques.

The number of light permeable tubes may vary, two is shown only to simplify the illustration. The protective casing 65 ensures that the possibly delicate tubes are protected from damage. The protective casing might furthermore comprise one or more elastic segments 66. The inclusion of an elastic segment 66 in the protective casing 65 will reduce the potential effect that vibrations induced from external sources have on the sensor. The protective casing 65 is preferably manufactured from a rather hard material to ensure that the interior is adequately protected from damaging effects. lt is also preferred if the material is a light weight material to ensure that the use of the sensor in, for example, a robotic limb is energy efficient.

The elastic segment 66 might, for example, be rubber or some other elastic material that can be bound to the protective casing 65. FlG.10b provides another illustration of the protective casing 65 with an elastic segment 66 where the internal components are hidden. The protective casing comprising the elastic segment could be attached to the flexible element comprising the sensor by attaching at least part of the casing to the frames 11a and 11b of the sensor. ln other words, it is provided a flexible element comprising a protective casing 65 that is partially enclosing the flexible element. The protective casing might comprise at least one segment 66 of an elastic material.

The elastic segment may be arranged at one end of the protective casing as seen in FIGKlOa but it might also be arranged at some other location such as in the middle of the casing, as illustrated in FIG 11a. An alternative view of a sensor comprising a protective casing 65 and elastic segment 66 is shown in FlG.1 1 B.

The proposed technology also provide a method that enables a determination of 22 the position or the orientation of a moving frame portion 11a of a sensor subject to applied forces and torques. The sensor comprises: ~ six spatially separated light permeable tubes 1, each tube having a first end 1a, arranged on a first frame portion 11a and a second end fb arranged on a second frame portion 11b, and wherein each of the six spatially separated light permeable tubes comprises, - a light detecting device 3, connectable to a processing unit 4, and arranged at a light detecting position of each of the light permeable tubes and configured to detect light emitted from a light emitting device 2 emitting light through each of the six light permeable tubes 1 and configured to transfer information comprising information relating to the detected light to the processing unit 4 to enable the processing unit to determine the bend of the light permeable tubes 1; to obtain values of the intensities of detected light having propagated through a light permeable tube.

The method that enables a determination of the position or the orientation of the moving frame portion of the sensor subject to forces and/or torques comprises: obtaining S1 the values of detected light intensities for light having propagated through different light permeable tubes; converting S2 the values of the detected light intensities to a specific length values corresponding to particular distances between the moving frame portion and a frame portion fixed relative said moving frame portion; determining S3 the position and/or the orientation of the moving frame portion relative the fixed frame portion based on the length values. lt should be noted that the method enables the determination of both the position and the orientation of the moving frame portion. The method may be used to first provide the positioning of the moving frame and then continue to provide the orientation of the moving frame relative the fixed frame by utilizing the determined position. ln the method above the moving frame portion may correspond to the first frame portion 11a of the described sensor and the frame portion fixed relative the moving 23 frame portion may correspond to the frame portion 11b of the described sensor. The method therefor provides a way to determine the orientation of frame portion 11a relative frame portion 11b and, as a consequence, the orientation of the sensor comprising frame portion 11a and frame portion 11b. lt will thereby be possible to 5 determine an orientation of a flexible element that comprises the sensor.

The step S3 of determining the position and/or the orientation of the moving frame portion relative the fixed frame portion may in a particular embodiment be performed by means of a numerical kinematic method where the length values are used as 10 input to the numerical kinematic method.

A numerical kinematic method is a well-known method and may also be referred to as a numerical Newton method that utilizes Lagrange multipliers. A direct outline of the method can be found in REF 7. A detailed description of how this method may 15 be used in a particular example will be given below.

The conversion between the values of the detected light intensities and the specific length values is preferably performed by means of a look-up table. The content of the table containing pre-determined conversion factors whereby a particular detected 20 intensity is mapped to a determined length value.

The table content can be obtained experimentally by performing measurements where the value of the distances between frame portions 11a and 11b are known and where the intensities are measured. ln this way will it be possible to provide a 25 direct mapping between detected intensities and corresponding distances.

The method is particularly useful for the case where the sensor comprises six light permeable tubes that extends between the frames of the flexible element, see any of FlGs 7-9 for an illustration of sensor that can be used to perform the method. 30 This positioning method provides for a numerical kinematic method that can be used for a flexible element that is provided with six tubes that extends between the frames of the flexible element. Preferably the tubes will be fastened to the frames so that the 24 fastening points lies in a common plane on each frame. The algorithm presented below displays robust convergence features if the fastening position of the tubes in the fixed frame correspond to the form of a hexagon and the fastening position of the tubes in the moving frame is provided in the form of a triangle, such as shown in FIG. 7.

Below we provide a more mathematical outline of the procedure, first define the following relations: gul; = llpfpjllf _ hä., i,j= 1,...,6 #1 .äts = (tm - tal X ifrßt. - ßtïll- (pl.- - vill si; = (tm. - rm) X ut - tal)- 'tm - m sig = (th: - til) K th; - 3213)- tm. - tft-ill' em = (tim - P23 >< tm _ Pall) ' (P1 "till ggn = (tm - 10331* (på -Ptflll- (m. -Pgš än = “på _ P33: 34 (Fa (ps "PQ s 31 s.. = :rattat - mp. - .titta + Etta :l iïl i These expressions can be used to determine the orientation of a flexible element by means of the following exemplary algorithm: 1. Set the values hä, to the squared distance between the points of fastening for tube i and tube j, in the frame to be positioned, that is the moving frame. 2. Set the vectors h, to the fastening positions of tube i for the fixed frame and the vectors p, to the positions where they were last located in relation to the center of the other frame.

Set n to some value, for example 0.0001.

Set Aim to some value, for example 0.3.

Sakmu Create :ck as xk = šfpi, mys-a, 3.1, .WAQJ k .OWFNPW 25 7. Find t.,f[I,f}, i=1,...,6 , in a calibration table for detected light intensities 1,, where i is the tube index. 8. Calculate gm., with the values of b, and p, from x* 9. Calculate Ph 5 10. Create IRM as .tzgtl = :ck -æg?fji 11.Set k = k + 1 12.lf sufficient number of iterations (such as k=1000) has been run continue to step 13, otherwise continue from step 8 13.Caiculate the position of the moving frame, T, in relation to the position of the 10 fastened frame by using points piga, and pa and known data about the fastening positions of the tubes in the moving frame in relation to the translation center of the moving frame 14. Find the orientation of the moving frame in relation to the fastened frame by using the positions pm by using geometric methods, such as the method by 15 F. L. Markley that solves Whaba's problem. See, e.g. Markley, F. L. Attitude Determination using Vector Observations and the Singular Value Decomposition Journal of the Astronautical Sciences, 1988, 38, 245-258 The values måga, creates rigidity constraints for the moving frame. These constraints 20 looks different for each tube setup. The setup shown creates rigidity constraints for tubes fastening positions in the form of a triangle, where each pair of fastening positions at the edge of the triangle is at the exact same position. For setups having more tubes than six the limits for indices i andj has to be changed and the vector :ak has to be expanded to hold all Lagrange multipliers .lt and the positions of all tube 25 fastening positions in the moving frame. Also more constraints g, and squared distances .hä has to be added.

The proposed method can in particular embodiments be performed by means of a computer program. The computer program comprises instructions, which when 30 executed by at least one processor, cause the processor(s) to: - read the values of detected light intensities for light having propagated through different light permeable tubes; - convert the values of the detected light intensities to specific length values corresponding to particular distances between the moving frame portion 5 and a frame portion fixed relative said moving frame portion; - determine the position and/or the orientation of the moving frame portion relative the fixed frame portion based on the length values.

The computer program may in particular convert the values of the detected light 10 intensities to specific length values by means of reading from a pre-determined table providing a mapping between detected light intensities and specific length values.

The computer program may also be provided with instructions that, when executed by at least one processor, cause the processor(s) to determine the orientation of the 15 moving frame portion relative the fixed frame portion by using the length values as input in a numerical kinematic method.

The proposed technology also provides a carrier comprising the computer program, wherein the carrier is one of an electronic signal, an optical signal, an electromagnetic 20 signal, a magnetic signal, an electric signal, a radio signal, a microwave signal, or a computer-readable storage medium.

By way of example, the software or computer program may be realized as a computer program product, which is normally carried or stored on a computer-readable medium, 25 in particular a non-volatile medium. The computer-readable medium may include one or more removable or non-removable memory devices including, but not limited to a Read-Only Memory (ROM), a Random Access Memory (RAM), a Compact Disc (CD), a Digital Versatile Disc (DVD), a Blu-ray disc, a Universal Serial Bus (USB) memory, a Hard Disk Drive (HDD) storage device, a flash memory, a magnetic tape, or any other 30 conventional memory device. The computer program may thus be loaded into the operating memory of a computer or equivalent processing device for execution by the processing circuitry thereof. 10 The computer program residing in memory may also be organized as appropriate function modules configured to perform, when executed by the processor, at least part of the steps and/or tasks described herein.

Alternatively it is possibly to realize the modules predominantly by hardware modules, or alternatively by hardware. The extent of software versus hardware is purely implementation selection.

Having described various embodiments of the proposed sensor together with a method that can be used to provide the orientation of a flexible element, below follows further descriptions and examples of embodiments of the sensor. These embodiments and examples are merely intended to facilitate the understanding of the invention and should not be construed as limiting for the scope.

The light detecting device(s) 3, 33, 333 of every light permeable tube 1 may be provided somewhere along the length of the light permeable tube 1. ln one embodiment it is provided on the second end 1b of the light permeable tube 1. By placing it there it is easy for an operator to reach it which makes it easier to replace the light detecting device if it is broken. ln another embodiment is the light detecting position provided somewhere along the length of the tube closer to frame portion 11b than frame portion 11a in the case that the light emitting device(s) 2, 22, 222 is provided at frame portion 11a. ln still another embodiment is the light detecting position provided in near proximity to the light emitting device. ln this embodiment is the light permeable tube 1 provided with a mirror that reflects the emitted light that have propagated through the light permeable tube 1 back towards the light detecting device(s) 3, 33, 333. This might also be preferred for repair and replacement considerations. The mirror could in this case be provided at the second end 1b of the light permeable tube if the light emitting device(s) is provided at the first end 1a of the light permeable tube. The mirror could also be provided within the tubes at particular positions as described above in relation to the light detecting position. As can be seen is there a multitude of choices of where to position the light detecting device along the light permeable tubes. The common feature of all the possible 28 10 positions is that they should be chosen so that the detected light has been able to propagate at least partially over the lengths of the light permeable tubes.

The sensor is in another exemplary embodiment provided with a processing unit that is connected to the light detecting device(s). ln still another embodiment is the processing unit 4 integrated with the sensor. That is, it forms part of the sensor. The processing unit 4 is, as earlier, configured to determine the bend of each of the at least two tubes in the sensor based on Characteristics of the detected light. The processing unit thus takes as input information comprising information regarding light Characteristics such as intensity and based on the input it determines the bend of the SGHSOT ln one exemplary embodiment is the processing unit, in both the case where it is integrated in the sensor or externally provided but connectable to the sensor, also provided with a determining unit. The determining unit is configured to determine the length between two reference points along each of the at least two light permeable tubes based on the determined bend of each of the light permeable tubes. Here two reference points, Pa and Pb, on each of the tubes used in the sensor are chosen in advance. Based on the determined bend of the different tubes the determining unit is configured to determine the length between these points. With lengths is here intended the Euclidean distance or the straight line connecting the points. Stated slightly more briefly, the determining unit takes as input the measures of bends of the tubes and determine the lengths between the selected points Pa and Pb of each of the light permeable tubes used in the sensor. To achieve a simple algorithm for computations it is preferred if the point Pa are centrally located within light permeable tube 1, 10 and are arranged at a location where the end portion 1a, 10a of the light permeable tube approximately connects to the frame portion 11a.

Correspondingly the point Pb should be chosen to be centrally located within the light permeable tube 1, 10 and located at a position along the tube that is approximately the position where the end portion 1b, 10b connects with the frame portion 11b. Other locations of the points Pa and Pb are however possible at the cost of computational complexity. The appendix provides an exemplary algorithm that can be used for this length determining step. 29 10 ln still another exemplary embodiment of a sensor according to the proposed technology there is provided a processing unit that comprises a computing unit. The computing unit is configured to compute, based on the determined lengths for each of the at least two light permeable tubes, a resulting vector corresponding to a vector directed from the frame portion 11a to the frame portion 11b. This unit therefore generates a vector that extends between the frame portions 11a and 11b.

One particular embodiment of a sensor that enables the positioning of a flexible element such as a robotic limb comprises light permeable tubes whose inside of the light permeable tubes is prepared to reduce reflections within, and obtain an even absorption along, the light permeable tubes. This might be done to counter the fact that some levels of bend might result in intensity spikes due to mirroring effects along the inner surface(s) of the tube(s) or that the bend estimation is dependent on the direction of the bend as a result of an uneven absorption in the tube. By processing the inner surface of the tube, by for example coating the surface with a coating or sanding it, so that the walls mostly reflects diffuse light the mirroring effects can be reduced making the bend estimation more precise. Another possible way to reduce the direct reflectivity is to provide the inside surface of the tube with soot. lt is preferred if the chosen measure to reduce direct reflection does not lead to light polarization changing effects. ln several embodiments of the sensor, embodiments that will be described below, is it preferable if the polarization of light stays constant during interactions between the light and the material of the light permeable tubes. lt might be also be an advantage for computational reasons if the inner surface of the tube is more or less homogeneous. lf the processing is made in a way that utilizes coatings or other materials so that the inner surface becomes homogenous and isotropic it is also possible to make the bend estimation for any particular direction by using only information on the relationship between bend and intensity readings for a single chosen direction. One possible way to obtain the features according to above is to sand the inner surface of the light permeable tubes and/or coat it with a silver paint. lt will be appreciated that the methods and devices described herein can be combined and re-arranged in a variety of ways.

For example, embodiments may be implemented in hardware, or in software for 5 execution by suitable processing circuitry, or a combination thereof.

The steps, functions, procedures, modules and/or blocks described herein may be implemented in hardware using any conventional technology, such as discrete circuit or integrated circuit technology, including both general-purpose electronic circuitry 10 and application-specific circuitry.

Particular examples include one or more suitably configured digital signal processors and other known electronic circuits, e.g. discrete logic gates interconnected to perform a specialized function, or Application Specific Integrated Circuits (ASlCs).

Alternatively, at least some of the steps, functions, procedures, modules and/or blocks described herein may be implemented in software such as a computer program for execution by suitable processing circuitry such as one or more processors or processing units.

Examples of processing circuitry includes, but is not limited to, one or more microprocessors, one or more Digital Signal Processors (DSPs), one or more Central Processing Units (CPUs), video acceleration hardware, and/or any suitable programmable logic circuitry such as one or more Field Programmable Gate Arrays 25 (FPGAs), or one or more Programmable Logic Controllers (PLCs). lt should also be understood that it may be possible to re-use the general processing capabilities of any conventional device or unit in which the proposed technology is implemented. lt may also be possible to re-use existing software, e.g. by 30 reprogramming of the existing software or by adding new software components. ln this particular example, at least some of the steps, functions, procedures, modules and/or blocks described herein are implemented in a computer program, which is loaded into the memory for execution by processing circuitry including one or more processors. The processor(s) and memory are interconnected to each other to 5 enable normal software execution. An optional input/output device may also be interconnected to the processor(s) and/or the memory to enable input and/or output of relevant data such as input parameter(s) and/or resulting output parameter(s).

The term 'processor should be interpreted in a general sense as any system or 10 device capable of executing program code or computer program instructions to perform a particular processing, determining or computing task.

The processing circuitry including one or more processors is thus configured to perform, when executing the computer program, well-defined processing tasks such as 15 those described herein.

The processing circuitry does not have to be dedicated to only execute the above- described steps, functions, procedure and/or blocks, but may also execute other tasks. 20 The embodiments described above are merely given as examples, and it should be understood that the proposed technology is not limited thereto. lt will be understood by those skilled in the art that various modifications, combinations and changes may be made to the embodiments without departing from the present scope as defined by the appended claims. ln particular, different part solutions in the different 25 embodiments can be combined in other configurations, where technically possible. 32 APPENDIX Section 1 Below is given a slightly more mathematical exposure of the principle behind the proposed technology. To facilitate the understanding a particular example is provided that is intended to provide the reader with an understanding of the principles. ln this example one light emitting source or device, henceforth called emitter, such as a LED, is arranged in a way that will allow it to emit light through a light permeable tube. A light detector, henceforth called detector, is in turn arranged in a way that allows it to detect the light intensity in the tube at some other position of the light permeable tube. Below this position is chosen at the opposite end of the light permeable tube from where the emitter is provided. Two reference points, Pa and Pb, are located on the neutral axis N, see e.g. FlGs. 12, 13 or 15, of the tube at different positions where Pa is closer to the emitter and Pb is closer to the detector. Two planes, Sa and Sb, is defined by the tangent of the tubes neutral axis in position Pa and Pb respectively. The intensity of the light shining through Sa and Sb in the orientation from the emitter to the detector is called la and lb. la and lb can be described by the following relations: la = oala (eq. 1a) lb = alla (eq. 1b) Id = ddlb (eq. 10) la in the equations above is the intensity of the light released by the emitter and la is the light intensity measured by the detector. The symbols aa, on and ola is the light attenuation in the tube from the emitter to Sa, from Sa to Sb and from Sb to the detector correspondingly. The attenuation from Sa to Sb is therefore given by equation 2. ou = la/ (olaolala) (eq. 2) Other combinations of equation 1a-1c can derive ou, such as the relation below: 33 orf= lb/ la (eq. 3) The tube is processed, through coatings or other means, so that light shining through Sa with intensity la can be detected by a detector at position Pb with the same intensity for a constant level of bend of the tube, between Sa and Sb, from the 5 tangent of the neutral axis in point Pa or Pb, regardless of the direction of the bend relative to the tubes neutral axis. The relation between dl and the bend of the tube between Sa and Sb is specific to the processing technique and material of the tube's inside and can be tested experimentally or derived analytically if enough material specifications is given. 10 The tube will attenuate light so that the curvature G of the bend of the tube between Sa and Sb, measured in radians, see FIG. 15, can be related to the attenuation on for predetermined values of the other attenuations and material specifications in the sensor. The curvature of the bend can be related to the absolute length L between Pa and Pb. lf a constant curvature assumption is used L can explicitly be given by 15 equation 4 where Lo indicates the length between Pa and Pb when the tube is not bent L = (zLb / e) sin (e/z) (4) lf no constant curvature assumption is used the relation between L and 9 can be determined experimentally. 9 can also be related to the magnitude of a resultant 20 force acting on the tube, creating the bend, when the acting point is in either Sa or Sb. The relation between 6 and the forces magnitude can also be determined experimentally. lf both the emitter and the detector are linearly polarized and if the emitter can rotate around the neutral axis of the tube relative to the detector, the angle of rotation 25 between the emitter and detector can be calculated. By Malus's law the intensity of light detected by the detector will be: la = oraortaalacoszhp), where axis of the detector and la is the absolute intensity of the polarized light of the 30 emitter. The angle cp is thus given by the relation: 34 15 20 25 :p = ILS ElTC-Cüåfíší? a' :- ti .s To make the emitter Iinearly polarized a polarizing film can be placed between the emitter and detector statically aligning it with the emitter around the tube's neutral axis. By analogue, the detector can be made Iinearly polarized by putting a polarizing film between the emitter and detector statically aligning it with the detector around the tube's neutral axis.

Section 2 Below is given a more detailed description of exemplary algorithms for positioning of a flexible element, such as a robotic limb, based on the methods and sensors described earlier. These are exemplary algorithms that are given to enable the skilled artisan to utilize the sensors. Other specific mathematical algorithms are however foreseeable and as such they can also be implemented to provide for a representation of the position of a robotic limb. 2D positioning algorithm The give the simplest possible setup the proposed method relates to a sensor that comprises two tubes of equal length whose ends are attached to two solid frames.

The fastening points in each frame are at equal length d from each frame's center. lt is assumed that the frame portion 11a is fixed in space with the frame lengthwise running parallel to the x axis, see FIG. 14. All bending motion will occur in the x-y plane by applying a force on the frame portion 11b. For this setup (see e.g. Fig.15 for the bend of a single tube) the exemplary algorithm used for 2D positioning of a flexible element can be divided into the following steps: 1. Determine the distance d from the center of the frame to each tube's neutral axis intersecting the plane of the frame, and measure the tube's initial length Lo. 2. Actívate the light emitting sources. 3. Determine the light intensity I for each level of bend 9 for each tube. 4. Measure the light intensity l for each tube: (l1, lz) 5. Determine the level of bend 9 for each tube from the intensities in step 3: (61, 92) 6. Calculate the lengths (h, lz) from the bends in step 4 and the tube's initial length Lo as: L = :gin-sin ” B. 2 B 7. Create the tuple q = (fyimd) and calculate _. ____ il?ïæ KÜÜ: arg +13) _g _2@ii(z H) _' _ “ .if-iii W*ïåfmTámä) - 1 q _.

K 3' ^ j?ü-Jlíï - ß?-Síi?ifl?-ïtfrl? = ï kTÉšg-j sínlfnr?g] 10 8. Calculate the vector from the reference point of the frame portion 11a to the other as (fi) = (är) +rw where is the center of the bottom frame and is the resultant vector from the origin to the reference point in the frame portion 11b.

To continually perform the 2D positioning steps 4-8 can be iterated after a first full run. 3D positioning algorithm The simplest setup for 3D positioning utilizes a sensor that comprises three tubes of 20 equal length whose ends are attached to two solid frames. The fastening points in each frame are at equal length from the frames center. The three fastening points are angularly fixed to be equal between the tubes and the frames center. The frame 36 15 portion 11a will be considered fixed in space parallel to the x-y plane. All bending motion results from the application of a force on frame portion 11b.

For this particular setup the algorithm used for 3D positioning of the flexible element can be divided into the following steps: 1.

S?PF-*JN Determine the distance d from the center of the frame to each tube's center, in the plane of the frame, and measure the tube's initial length Lo.

Activate the light emitting sources.

Determine the light intensity I for each level of bend 6 for each tube.

Measure the light intensity I for each tube: (i1, iz, is) Determine the level of bend 6 for each tube from the intensities in step 3: (61, 6 2, 6 s) Calculate the lengths (l1, lz, Is) from the bends in step 4 and the tube's initial length Lo as: tg» = --sån L' 7.

S i Create the tuple .q = lïtyífwtgyd) and calculate l , -l- i, - EE _ __: ; -1 E 3 i) (q) mn (Vïšflz '_ Ia) i :_ E?lrïš + 'gå "i" _ 313m "51313 '” 123.3 ' dlftl wl- »lg +13] i *H51 'i i: +13) _ ...i + få "i" å _' â?: _ lat: "' Lata = llfïq) = g E g g sm råd Bifall-t 11+ ta - litg- tig-täta ~ lf). - cos?cfq?lfq?l) cnsfä??qll) Ftfzl* = u - ßøßlíßtqfait-wlnzsmtstqi: pf?ß?nlí?tqzfi-tqan Calculate the vector from the center of the first frame to the other as Gå) = + fit-alt, »b z where is the center of frame portion 11a and is the resultant vector En 3% from the origin to the reference point in frame portion 11b. 5 To continually perform the 3D positioning steps 4-8 can be iterated after a first full run. 5 25 REFERENCES Ref 1: K. Xu, N. Simaan, “An Investigation of the Intrinsic Force Sensing Capabilities of Contínuum Robots”, IEEE Transaction on Robotics, V01 23, pp. 576-587 Ref 2: E. J. Lobaton, J. Fu, L. G. Torres, R. Alterovítz, “Continuous Shape Estimation of Continuum Robots Using X-ray Images” Ref 3: J. M. Croom, D. C. Rucker, J. M. Romano, R. J. Webster III,“Visual Sensing of Continuum Robot Shape Using Self-Organizing Maps”, IEEE International Conference on Robotics and Automation, 2010 Ref 4: G. Chen, M. T. Pham, T. Redarce, “Sensor-based guidance control of a continuum robot for a semí-autonomous colonoscopy”, Robotics and Autonomus Systems, Vol 57, pp. 712-722 Ref 5: US2006045408A1, Jones et al Ref 6: Kesner, Gavalis et al, “Multifiber optical bend sensor to aid colonoscope navigation”, Optical Engineering 50(l2), 124402, December 201 1 .

Ref 7: Cruz, Ferreira, Sequeirs: “Modelling two classes of SteWart-Gough platforms”.

Claims

PATE NTKRAV 1. En sensor for att mojliggora on positionering av ett flexibelt element utsatt fürpalagda krafter, sensorn innefattar: - atminstone tva rumsligt separerade ljusgenomslappliga rbr (1, 10), vart och ett av (Oren (1, 10) har en forsta ande (1a, 10a) anordnad pa ett fOrsta ramavsnitt (11a) och en andra ande (1 b, 10b) anordnad pa ett andra ramavsnitt (11b) pa det flexibla elementet, van i atminstone en av namnda fOrsta ande (1a, 10a) och andra ande (1 b, 10b) pa atminstone ett ljusgenomslappligt rbr (1, 10) ar fast till ett motsvarande fOrsta ramavsnitt (11a, 11 b) medelst ett forbindelseorgan (120); och van i vart och ett av namnda atminstone tva rumsligt separerade ljusgenomslappliga rtir vidare innefattar, - atminstone en ljusdetekteringsanordning (3), vilken kan anslutas till en processorenhet (4), och vilken ar anordnad vid en ljusdetekteringsposition fur ett motsvarande ljusgenomslappligt rbr (1, 10) och vilken ar konfigurerad att detektera ljus emitterat fran atminstone en ljusemitterande anordning (2) genom motsvarande ljusgenomslappliga ran (1, 10) och konfigurerad att overfOra information innefattande information avseende dot detekterade ljuset till processorenheten (4) for att Ora dot mbjligt for processorenheten (4) att bestamma bojningen pa de ljusgenomslappliga (Oren (1, 10). 2. Sensorn enligt patentkrav 1, van i varje ande pa atminstone ett ror (1, 10) ar fast till motsvarande ramavsnitt (11a, 11b) medelst forbindelseorgan (120). 3. Sensorn enligt patentkrav 1 eller 2, van i namnda forbindelseorgan (120) innefattar ett sfariskt ledlager oiler en kardanknut. 4. Sensorn enligt patentkrav 3, van i en ande pa atminstone ett rtir (1, 10) ar fast medelst ett sfariskt kullager och den andra anden pa namnda atminstone ett ljusgenomslappliga rtir (1, 10) är fast medelst en kardanknut. 5. Sensor enligt nagot av patentkraven 1-4, van i namnda sensor innefattar en ljusemitterande anordning (3) innefattande ett flertal ljusemitterande dioder, dar varje ljusemitterande diod ar konfigurerad att emittera ljus av en farbestamd vaglangd. 6. Sensorn enligt n6got av patentkraven 1 till 5, vari namnda sensor vidare innefattar Atminstone en referensdetektor (30, 350, 355), namnda Atminstone en referensdetektor ar anordnad i narheten av den ljusemitterande anordningen (2) och ar konfigurerad att detektera ljus emitterat fr6n ljusemitteringsanordningen fOre namnda ljus intrader i namnda ljusgenomslappliga rOr (1, 10) for att erh61Ia referensvarden for viss ljuskaraktaristik has namnda emitterade ljus. 7. Sensorn enligt patentkrav 6, van i sensorn aven innefattar en straldelare anordnad mellan den ljusemitterande anordningen (3) och det ljusgenomslappliga roret, namnda str6Idelare ar konfigurerad att rikta delar av det ljus som emitteras fr6n den ljusennitterande anordningen (3) till referensdetektorn (30). 8. Sensorn enligt nagot av patentkraven 1-7, van i namnda sensor vidare innefattar atminstone ett diffusionsfilter (45, 450) anordnat mellan den ljusemitterande anordningen (3) och det ljusgenomslappliga rOret (1). 9. Sensorn enligt nagot av patentkraven 1-8, vari namnda sensor innefattar sex rumsligt separerade ljusgenomslappliga ror (1, 10). 10. Sensorn enligt n6got av patentkraven 1-9, van i antalet ljusdetekterande anordningar (3) och ljusemitterande anordningar motsvarar antalet ljusgenomslappliga r6r och van i var och en av namnda ljusdetekterande anordningar (3) och ljusemitterande anordningar (2) anyands fOr ett designerat ljusgenomslappligt ror (1, 10). 11. Sensorn enligt n6got av patentkraven 1-10, van i namnda ljusemitterande anordning (2) innefattar en laser och van i namnda ljusdetekterande anordning (3) innefattar en grupp av ljusdetekterande anordningar (3). 12. Ett flexibelt element innefattande en sensor enligt n6got av patentkraven 1-11. 13. Det flexibla elementet enligt patentkrav 12, van i namnda flexibla element vidare innefattar ett skyddande hOlje (65) som innesluter delar av det flexibla elementet. 14. Det flexible elementet enligt patentkrav 13, van i namnda skyddande holje innefattar atminstone ett segment (66) av ett elastiskt material. 15. En metod fOr att faststalla orienteringen has ett rOrligt ramavsnitt pa ett flexibelt element medelst anvandning av en sensor enligt nagot av patentkraven 1-11, metoden innefattar stegen att:

1. erhalla (Si) varden pa detekterade ljusintensiteter fOr ljus som propagerat genom alike ljusgenomslappliga rbr; och

2. konvertera (S2) de erhallna vardena pa de detekterade ljusintensiteterna till motsvarande langdvarden vilka representerar specifika aystand mellan namnda rorliga ramavsnitt och ett andra ramavsnitt pa namnda flexible element vilket an fixerat relativt namnda rorliga ramavsnitt;

3. faststalla (S3) positionen och/eller orienteringen for det rorliga ramavsnittet relativt det fixerade ramavsnittet genom att anvanda langdvarden som indata i en direkt numerisk kinematisk metod. 1/ Obtain values for detected light intensities .7-- S1 i Convert the values of the detected light intensities to length values I S2 Determine the orientation of the movings3 frame portion based on the lenght values