PROBE GUIDING
20200370997 ยท 2020-11-26
Assignee
Inventors
Cpc classification
G05B2219/40234
PHYSICS
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
G05B2219/40206
PHYSICS
B25J9/1625
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A techniques for improved guiding of hyper-redundant manipulator probes into a constrained space which make use of the known characteristics of the space into which the probe is being inserted to increase the efficiency of the computation of the path of the probe. Embodiments of the invention achieve this through an optimisation function which determined a new orientation which minimises the deviation between each of: a) the point on the probe where the probe starts to follow a defined curve within the constrained space and a predetermined initial point, and b) the distal end of the probe and said defined curve.
Claims
1. A method for guiding a probe inside a constrained space, wherein the probe is a hyper-redundant manipulator comprising a plurality of independently-orientable connected segments extendable between a proximal end and a distal end inside the constrained space, the method including the steps of: determining: an initial point (p.sub.1) where the probe intersects a predetermined curve (C) which defines a circle or part circle within said space; and an initial bend for the probe between an entry point on a surface of the constrained space and the initial point; and, repeatedly: determining a new orientation of said segments which results in an advancement of the distal end to a new position which is on said curve, the new orientation being determined so as to minimise the deviation between each of: a) the point on the probe where the probe starts to follow said curve and the initial point, and b) a point (p.sub.2) on the probe closer to the distal end than the point where the probe starts to follow said curve and said curve; and adjusting the orientation of said segments to said new orientation and advancing the probe so that the distal end is located at the new position.
2. A method according to claim 1 wherein the steps of determining the new orientation and adjusting the manipulator are performed in real-time or substantially in real-time.
3. A method according to claim 1 wherein the constrained space is toroidal.
4. A method according to claim 1 wherein the curve defines a mid point of the space.
5. A probe system for accessing a constrained space, the probe system comprising: a hyper-redundant manipulator having a plurality of independently-orientable connected segments extendable between a proximal end and a distal end; and a controller, wherein the controller is arranged to control the orientation of said segments so as to position the distal end in a desired position by: determining: an initial point (p.sub.1) where the probe intersects a predetermined curve (C) which defines a circle or part circle within said space, and an initial bend for the probe between an entry point on a surface of the constrained space and the initial point; and, repeatedly: determining a new orientation of said segments which results in an advancement of the distal end to a new position which is on said curve, the new orientation being determined so as to minimise the deviation between each of: a) the point on the probe where the probe starts to follow said curve and the initial point, and b) a point (p.sub.2) on the probe closer to the distal end than the point where the probe starts to follow said curve and said curve; and sending actuation signals to the manipulator so to as to cause adjustment of the orientation of said segments to said new orientation and advance the probe so that the distal end is located at the new position.
6. A probe system according to claim 5 wherein the controller performs the steps of determining the new orientation and adjusting the manipulator in real-time or substantially in real-time.
7. A probe system according to claim 5 further including an end-effector at the distal end of the manipulator.
8. A probe system according to claim 5 wherein the constrained space is toroidal.
9. A probe system according to claim 5 wherein the curve defines a mid point of the space.
10. A probe system according to claim 5 further including a feed-in mechanism for advancing the probe.
11. A probe system according to claim 5 further including an actuation mechanism located at or near the proximal end, the actuation mechanism either being linked to actuators on each segment or arranged to directly drive the motion of each segment.
Description
[0029] Embodiments will now be described by way of example only, with reference to the Figures, in which:
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037] With reference to
[0038] The gas turbine engine 10 works in the conventional manner so that air entering the intake 12 is accelerated by the fan 13 to produce two air flows: a first air flow into the intermediate pressure compressor 14 and a second air flow which passes through a bypass duct 22 to provide propulsive thrust. The intermediate pressure compressor 14 compresses the air flow directed into it before delivering that air to the high pressure compressor 15 where further compression takes place.
[0039] The compressed air exhausted from the high-pressure compressor 15 is directed into the combustion equipment 16 where it is mixed with fuel and the mixture combusted. The resultant hot combustion products then expand through, and thereby drive the high, intermediate and low-pressure turbines 17, 18, 19 before being exhausted through the nozzle 20 to provide additional propulsive thrust. The high 17, intermediate 18 and low 19 pressure turbines drive respectively the high pressure compressor 15, intermediate pressure compressor 14 and fan 13, each by suitable interconnecting shaft.
[0040] Other gas turbine engines to which the present disclosure may be applied may have alternative configurations. By way of example such engines may have an alternative number of interconnecting shafts (e.g. two) and/or an alternative number of compressors and/or turbines. Further the engine may comprise a gearbox provided in the drive train from a turbine to a compressor and/or fan.
[0041] Gas turbine engines such as those shown in
[0042]
[0043] The end-effector 34 is located at the distal end of the arm 32 and is chosen depending on the scenario for which the probe is to be used. For example, the end-effector 34 may include one or more of a vision system (e.g. a camera device or similar and, optionally, an illumination device), a gripper, a high-speed spindle, etc. The end-effector 34 may be interchangeable so that the same probe system can be used for a variety of purposes.
[0044] The actuation mechanism 36 is located at the proximal end of the arm 32. This mechanism drives the movement of the arm 32 either by sending drive signals to individual actuators located on and/or between each section, or by operating actuators which are physically connected to each section (e.g. pneumatically, hydraulically or by cables). By mounting the actuation mechanism 36 at the proximal end, the actuation mechanism 36 (or least part of it) can be kept off the moving part of the arm 32 thereby reducing the weight of the arm and making its motion easier.
[0045] The feed-in mechanism 38 allows advancement (and retraction) of the arm 32. The feed-in mechanism 38 provides accurate linear advancement of the arm along the initial trajectory (the orientation of the arm shown in
[0046] The arm 32 is split into a number of distinct sections 33. Each section has two degrees of freedom and can be formed into a curve of any angle (referred to as :) up to a pre-determined maximum angle (usually limited by the design of the sections 33 to a maximum of around 90 or (u)/2) from the straight-line axis. Further, the section can form this arc such that the tip of the section subtends any desired angle (referred to as -) from an axis perpendicular to the straight-line axis.
[0047] The arm 32 depicted in
[0048]
[0049] In order to perform a general inspection of the combustion chamber 16, it is desired to pass the arm of the probe (which may have, for example, a light source and a camera located at its distal end or tip in order to perform this inspection) around a circular path C which is mid way between the inner and outer walls, 16a, 16b. Due to the torus shape of the combustion chamber 16, the path is well-defined and has a constant curvature.
[0050] Thus, as shown in
[0051] The initial angle and initial point p.sub.1 will be dependent on a number of factors, including the location of the entry port 40, the distance between the entry point and the path C and the direction of the subsequent second section of the arm. However, for an entry port 40 on the inner or outer wall of a toroidal space, it is likely to be slightly under or over 90. The initial angle can be determined manually, or can be computed from inputs of the relevant factors.
[0052] To advance the arm 32 along the path C, using a tip-following approach (curve following as the tip will always follow the curved path C), an optimisation process is employed which is used to drive the actuation mechanism 36 and advance the arm 32 and the tip along the path C.
[0053]
[0054] The starting point is the configuration of
[0055] An example optimization process for determining the positioning and orientation of the arm 32 will now be described. However, it will be appreciated that other optimization processes can be used.
[0056] It is well-known that the effectiveness of an optizimation process is largely determined by the definition of the objective function. The main problem with creating objective functions for hyper-redundant manipulators has been that the optimization function has to include both the accuracy of the tip position (which is normally relatively simple) as well as the deviation of the remainder of the arm from the desired path (which is not so simple).
[0057] However, in the present embodiment, the objective function can be simplified as it is only reliant on comparison of the path with the points p.sub.1 and p.sub.2. Therefore, for each advancement of the tip p, which results from a linear advancement b of the arm at the base, the objective function can be written as:
[0058] Where and
are the calculated positions of points p.sub.1 and p.sub.2 for an advancement of x at the base of the arm. and
are weighting coefficients which are used to tune the performance of the objective function. Usually
will be chosen to be significantly larger (e.g. by an order of magnitude) than as the position of the tip is much more important than the intermediate arrangement of the arm, but this may vary depending on the circumstances (e.g., in a particularly constrained access situation, deviation in p.sub.1 may be undesirable and so the weightings may be more even, or even reversed).
[0059] The objective function can then be used in a movement algorithm such as the following, which is also depicted schematically in
[0060] As a result of the simplifications to the optimization process that can be made by the reliance on the two points for navigation, the computational load of the optimizing step (which is the rate-limiting step), significant performance improvements were obtained compared to, for example, a similar approach without such constraints as mapped out in Palmer et al..
[0061] Performance improvements in the control of hyper-redundant manipulators can take two forms: faster computation can allow faster movement/progression of the tip with the same accuracy; or faster computation can mean that more accurate solutions are searched for by either considering a greater range of possible configurations, or by using smaller incremental advancements (p in the above description).
[0062] By comparing the performance of the tip-following approach in Palmer et al. and the approach of the present embodiment, it was found that the optimization step of the present embodiment took approximately 20% of the time taken for the optimization step of Palmer et al. using the same increments.
[0063] Further, once a pattern of movements have been determined for the advancement of a whole section of the arm into the target space, the orientations for each partial step of the advancement fora particular p can be stored and used for the insertion of the next segment, rather than calculating afresh.
[0064] It will be understood that the invention is not limited to the embodiments above-described and various modifications and improvements can be made without departing from the concepts described herein. Except where mutually exclusive, any of the features may be employed separately or in combination with any other features and the disclosure extends to and includes all combinations and sub-combinations of one or more features described herein.