MEASUREMENT SYSTEM AND METHOD FOR MEASURING ANGLES AND DISTANCES
The present invention relates to a system and a method for measuring angles and distances between to modules.
In many situations it is required to simultaneously measure a distance between two objects and an angle of which one of the objects is rotated relative to the other. Numerous measurement methods are available for measuring distance between two objects, e.g. triangulation, time-of-flight, and auto focus. Also many different systems have been invented for measuring an angle of one object relative to another. There are even systems for measuring distance as well as an angle between two objects, but these systems are dedicated to specific applications, and are often difficult to adapt to other applications. These measurement systems are build into larger systems providing information for e.g. a micro-controller manipulating one of the objects or for calculating data related to the measurements.
It is an object of the present invention to provide a system, which is fast and easy to mount on many different objects. The system should be capable of providing a distance to an object and an angle relative to the observer in an easy and fast manner.
The present invention provides an easy to mount measuring device for measuring the distance between two objects as well as an angle of rotation of a second object relative to a first object.
The above-mentioned objects are complied with by providing, in a first aspect, a system for determining an angle and a distance between a first and a second module, wherein the first module comprises
- first, second and third radiation means, the first and second radiation means being separated by a known first distance, the first and third radiation
means being separated by a known second distance, and the second and third radiation means being separated by a known third distance,
and wherein the second module comprises
- image forming means, and
- an array of optical sensors being positioned at a fixed distance from the image forming means so that images of the radiation means of the first module are projected onto the array of optical sensors.
Preferably, the system further comprises
- means for switching the first, second and third radiation means on and off in a predetermined sequence,
- means for transforming images formed on the array of optical sensors into sets of digital data,
- means for transmitting sets of digital data from the transforming means to a first calculating means, said first calculating means being adapted to calculate, from sets of digital data representing the second and third known distances, a first ratio, said first ratio being proportional to the angle between the first module and the second module, and said first calculating means further being adapted to calculate, from the set of digital data representing the first known distance, the distance between the first module and the second module, and scaling said set of digital data with a scaling factor proportional to the first ratio.
The above-mentioned means (switching means, transforming means, and first calculating means) may all be implemented as electronic means, such as an analogue circuit, or they may be implemented as digital means - e.g. comprising a microprocessor or a PC, or any combination thereof.
The first module may further comprise a fourth radiation means positioned at a fourth known distance from the third radiation means, and a fifth radiation means positioned at a fifth known distance from the third radiation means. Preferably, the first, second, fourth and fifth radiation means are positioned in a first plane.
The first calculating means may, from the set of digital data representing the fourth and fifth known distances, calculate a second ratio, the second ratio being proportional to the second angle between the first module and the second module.
The system may further comprise a second calculating means for calculating a rotation of the first module relative to the second module by calculating the position of the projected images of the first, second, fourth, and fifth radiation means. The second calculating means may also be implemented as electronic means, such as an analogue circuit, or it may be implemented as digital means - e.g. comprising a microprocessor or a PC, or any combination thereof.
The first calculating means may be capable of determining a parallel translation of the position of the first module relative to the second module. The array of optical sensors may comprise a one-dimensional and/or a two-dimensional CCD camera or CMOS array. Alternatively, the array of optical sensors may comprise at least two one-dimensional CCD cameras or CMOS arrays, and may further comprise a beam-splitter. The radiation means may comprise LED's, lasers and/or reflectors so to reflect incoming light. The image forming means may comprise a lens, such as a cylinder lens or pinhole.
In a second aspect, the present invention relates to a method for determining an angle and a distance between a first and a second module, said method comprising the steps of
1. providing the first module, said first module comprising a first, second and third radiation means, the first and second radiation means being separated by a known first distance, the first and third radiation means being separated by a known second distance, and the second and third radiation means being
separated by a known third distance,
2. providing the second module, said second module comprising image forming means and further comprising an array of optical sensors, said array of optical sensors being positioned at a fixed distance from the image forming means so that images of the radiation means of the first module are projected onto the array of optical sensors,
3. switching the radiation means on and off in a predetermined sequence,
4. transforming images formed on the array of optical sensors into sets of digital data,
5. calculating, from sets of digital data representing the second and third known distances, a first ratio, said first ratio being proportional to the angle between the first and second module, and
6. calculating, from the set of digital data representing the first known distance, the distance between the first and second module, and scaling said set of digital data with a scaling factor proportional to the first ratio.
The required means for performing the above-mentioned method are similar to the means according to the first aspect of the present invention.
The invention will now be described in further details with reference to the accompanying figures where,
Fig 1 is a block diagram of the measurement system of the present invention,
Fig 2 is a schematic plan view of optical part of the measurement system with 3 radiation means in the first module,
Fig 3 is a schematic plan view of optical part of the measurement system with 3
radiation means in the first module, and where the first module is rotated relative to the second module,
Fig 4 is a schematic view of the first module with 5 radiation means, and
Fig 5 is a schematic view of the embodiment with two 1 -dimensional image transforming means.
In Fig 1 a block diagram of the present invention is shown. A first module 1 is placed on an object together with first electronic means 3. A second module 2 is placed at a distance 9 from the first module 1 together with the second electronic means 4, and also the third electronic means 5 and the fourth electronic means 6 are placed at the first module 1. The first module 1 may be rotated an angle 8 relative to the second module 2.
In Fig 2 and Fig 3 a more detailed view of the first module 1 and the second module 2 is shown. The first module 1 comprises a first radiation means 20 and a second radiation means 22. The first module 1 further comprises a third radiation means 24 positioned behind a line connecting the first radiation means 20 and the second radiation means 22. The first distance 40 between the first radiation means 20 and the second radiation means 22 is known to the system. In a preferred embodiment of the present invention the distances 44 and 42 are approximately the same and also know to the system. The x-component of the third distance 42 is denoted 42x and the x-component of the second distance 44 is denoted 44x.
The second module 2 comprises an image forming element 10 as well as a second electronic means 4 for transforming the image into digital data.
When measurements are performed, the first electronic means 4 controls the radiation means 20, 22, and 24 of the first module 1 to be turned on and off one after the other. When one of the radiation means 20, 22, or 24 is turned on, an image 20', 22' or 24' of the radiation means is formed on the second electronic
means 4. The image is digitised and transferred via the third electronic means 5 to the fourth electronic means 6 where the position of the image of the radiation means is calculated. When all three radiation means 20, 22, and 24 has been turned on and off, the fourth electronic means 6 calculates the distances 40', 42x' 5 and 44x'.
The ratio between the distances 42x' and 44x' is proportional to the angle 8 of which the first module 1 is rotated around the rotational axis 30. A shift in distance 9 between the first module 1 and the second module 2 will change the distances 10 42x' and 44x', but the ration between them will not change.
The first module should be rotated around rotational axis 30 lying on the line connecting the first radiation means 20 and the second radiation means 22. Preferably, the rotational axis 30 is at the centre of the line.
15
Due to a rotation of the first module 1 around the rotational axis 30 the distance 40' is scaled with the ratio between the distances 42x' and 44x'. The distance 40' is proportional to the distance 40 and the ratio between the distances is proportional to the distance 9 between the first module 1 and the second module
20 2.
If no rotation of the first module 1 has been made, the ratio between the distances 42x' and 44x' will be 1 , and the ratio between the distances 40 and 40' will be proportional to the distance 9. 5
If however a rotation of the first module 1 has been made, the ratio between the distances 42x' and 44x' will be different from 1 , and the distance 40' should be scaled with this ratio before calculating the distance 9.
30 This may also be expressed as
Angle 8 = , (40/40')
and
Distance 9 - 40' ki f2(Angle 8),
where fi. and f2 are linear functions determined during calibration of the measurement system.
A translation perpendicular to the distance 9 of the first module 1 relative to the second module 2 may be calculated. If no translation is present, the centre point between the first radiation means 20 and the second radiation means 22 will be at a predetermined position. During a translation this point will shift, and the shift is proportional to the translation that may be calculated by:
Translation 50 = Translation in pixels * pixelsize * distance 9 / 2*distance 52
In a preferred embodiment of the present invention the first module 1 further comprises a fourth radiation means 101 and a fifth radiation means 102. These radiation means are placed in the same plane as the first radiation means 20 and the second radiation means 22 and at known distances from these radiation means. The third radiation means 24 of the first module 1 should not be placed in that plane. This is shown in Fig 4, where the line connecting the fourth radiation means 101 and the fifth radiation means 102 should be perpendicular to a line connecting the first radiation means 20 and the second radiation means 22. In this embodiment the fourth electronic means 6 is capable of calculating a second ratio between the fourth known distance and the fifth known distance. This ratio is proportional to the second angle between the first module and the second module.
In yet another preferred embodiment of the present invention the system further comprises a fifth electronic means being capable of calculating the rotation of the first module relative to the second module. The calculation is performed by determining the positions of the first radiation means 20, the second radiation means 22, the fourth radiation means 101 , and the fifth radiation means 101 , and comparing these positions with standard values for known rotations.
In a preferred embodiment of the present invention the radiation means of the first module 1 are light emitting diodes (LED's), but also other types of light emitting devices may be used, e.g. a diode laser or a small light bulb.
In another preferred embodiment of the present invention the radiation means are retro reflecting reflectors. In this embodiment the light is sent from the second module 2 to the reflectors of first module 1. The reflectors will in turn reflect the light back into the image forming means 10 of the second module 2. This embodiment is preferable when it is desired not to have any electronic means for driving the radiation means of the first module 1.
In another preferred embodiment the image forming means 10 of the first module 1 is a lens and in yet another preferred embodiment of the present invention, the image forming means 10 is a cylinder lens. A cylinder lens is preferable as it translates/projects/focuses the image of the radiation means into a line of light perpendicular to the 1 dimensional array og optical sensors making alignment of the measurement system easier.
In an embodiment of the present invention where five radiation means are used, one may use a standard lens creating an image on a 2 dimensional array of optical sensors. It is also possible to use a beam splitter, two cylinder lenses, and two one-dimensional arrays of optical sensors. This is shown in Fig. 5, where the beam splitter 60 separates the image of the first module 1 into two images of preferably 50% light intensity. Each of the images are focused onto each their 1- dimensional array of optical sensors (64, 62) using cylindrical lenses (66,68). The two cylindrical lenses (66,68) should be rotated 90° relative to each other. The advantage of this arrangement is the possible use of two pieces of simple 1- dimensional optical sensors in stead of one more complex 2-dimensional array. The image processing of two 1 -dimensional arrays are much faster and easier that processing of one 2-dimensional array.
In yet another preferred embodiment of the present invention, the image forming means 10 may be a pinhole.
The array of optical sensors may be a CCD line scan camera in either 1 or 2 dimensions or a CMOS array in 1 or 2 dimensions. It is obvious, that also other optical sensors may be used, such as a PSD (position sensitive device).
The first electronic means for turning on and off the radiation means of the first module in a predetermined sequence may comprise a micro controller, e.g. a Microchip PIC, where one port of the micro controller controls one radiation means. Timing of when a radiation means should be turned on and off may be generated by the first electronic means itself, or it may be received from one of the other electronic means, preferably from the fourth electronic means, either by wire or via wireless communication. Wireless communication between the first electronic means and one or more of the other electronic means is in a preferred embodiment made via BlueTooth technology, but also infrared communication is within the scope of this invention.
The second electronic means for transforming the image formed on the array of optical sensors into a set of digital data, may be an analog to digital converter.
The third electronic means for transmitting the set of data form the second electronic means to the fourth electronic means may be a simple cable connection, or it may be a wireless connection using BlueTooth technology or infrared communication.
In a preferred embodiment of the present invention, the fourth electronic means comprise a master micro controller capable of controlling the first electronic means to turn on and off the radiation means, the master micro controller further being capable of controlling the image forming means and the second electronic means for transforming the image into a set of digital data and for calculating the distance and angles between the first module and the second module. The micro controller may be a Microchip PIC or a similar micro controller or a PC.
A number of factors define the accuracy of which the measurement system can calculate the angle 8 and the distance 9. If the distances 42 and 44 are small, the
difference between the distances 42x' and 44x' will be smaller than if the distances 42 and 44 are larger. A smaller difference reduces the accuracy of the measurement of the angle 8. On the other hand, small distances 42 and 44 will increase the size of the angle 8 that may be measured using the present invention. It is therefore apparent for a person skilled in the art, that the invention may easily be adapted to different measurement needs.
It is also apparent that the alignment of the system to a large extent is uncritical. E.g. a parallel translation of the second module in relation to the first module will be seen on the image forming means as a translation of the images of the radiation means. The ratios being calculated will not be influenced of the parallel translation as long as the images of the radiation means to not fall outside the image forming means.
When a system has been installed, i.e. when the first module 1 and the second module 2 has been positioned on the objects to monitor and the initial position has been determined, a parallel translation of the second module in relation to the first module may be detected by determining the parallel translations of the images of the radiation means.
As an example of the use of the present invention consider a transportable staircase for airliners. At the arrival at the airport, the transportable staircase is moved so as the staircase is positioned just outside the door of the airliner. In this way it is in many airports possible for the passengers of the airliner to walk from the aeroplane directly into the terminal of the airport without getting into open air.
The control of the movements is usually done by human hand, but using an instance of the present invention, this may be automated. On the aeroplane, behind the door, a first module is placed. The first module comprise a self adhesive label with 4 small retro reflective areas, and a fifth small area elevated a few mm above the label. A second module is placed on the transportable staircase.
When the airliner has parked, a laser diode transmits laser light onto the label, and the image forming means captures an image of the 5 retro reflective areas. The electronic means of the second module is capable of determining the position of the door of the aeroplane, and the knowledge of the position is used to move the staircase towards the aeroplane. The position information may be updated while moving the staircase, and the best position for the staircase may therefore be achieved in one smooth movement.