WO2010047078A1 - 6方向指向装置 - Google Patents
6方向指向装置 Download PDFInfo
- Publication number
- WO2010047078A1 WO2010047078A1 PCT/JP2009/005448 JP2009005448W WO2010047078A1 WO 2010047078 A1 WO2010047078 A1 WO 2010047078A1 JP 2009005448 W JP2009005448 W JP 2009005448W WO 2010047078 A1 WO2010047078 A1 WO 2010047078A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- axis
- angular velocity
- directing device
- degrees
- guide
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/02—Rotary gyroscopes
- G01C19/34—Rotary gyroscopes for indicating a direction in the horizontal plane, e.g. directional gyroscopes
- G01C19/38—Rotary gyroscopes for indicating a direction in the horizontal plane, e.g. directional gyroscopes with north-seeking action by other than magnetic means, e.g. gyrocompasses using earth's rotation
Definitions
- the present invention relates to a six-direction pointing device, and more particularly to a six-direction pointing device that can be used for a true north detector (North Finder) that detects true north using a single-axis gyro.
- North Finder true north detector
- a gyro compass that detects true north by detecting the rotational angular velocity of the earth has been used.
- the gyrocompass is generally an orthogonal three-axis type. These gyrocompasses are large and expensive.
- the azimuth meter described in Japanese Patent Application Laid-Open No. 6-3149 is a single-axis type, and rotates an angular velocity sensor (gyro sensor) at a constant angular velocity on a horizontal table.
- the compass described in Japanese Patent Application Laid-Open No. 6-11350 is a single-axis type, and a temporary true north is obtained by rotating a gyro sensor on a horizontal table.
- a bias is obtained from the angular velocity measurement value at the provisional true north and the separately input latitude, and true north is obtained again.
- 11-160072 is a two-axis type that does not require a horizontal plane, and measures by rotating the gyro sensor every 90 degrees or 120 degrees on two turntables. Remove.
- the compass described in Japanese Patent Application Laid-Open No. 11-190633 is a single-axis type that does not require a horizontal plane, and directs a gyro sensor and an acceleration sensor in three directions on a turntable. However, it is necessary to enter the latitude.
- the azimuth detecting device described in Japanese Patent Laid-Open No. 2001-215121 is a single-axis type, and a true girth is obtained from a sinusoidal gyro output by rotating a gyro sensor on a horizontal plane.
- gyrocompasses are of a type in which a gyro sensor and an acceleration sensor are rotated on a turntable.
- the rotation angle is large and a large space needs to be secured, there is a limit to downsizing.
- many of the single-axis type gyrocompasses require a horizontal surface and are inconvenient to handle.
- a single-axis type gyro compass that does not require a horizontal plane has been proposed, but the orientation measurement accuracy is inferior to that of the three-axis type.
- the present applicant has proposed a azimuth measuring apparatus which is a single-axis type and does not require a horizontal plane in Japanese Patent Application Laid-Open No. 2008-215956.
- a UVW orthogonal coordinate system is assumed in addition to the XYZ orthogonal coordinate system.
- the six directions + U, ⁇ U, + V, ⁇ V, + W, and ⁇ W are spaced apart by 60 degrees when projected perpendicularly to the YZ plane.
- the elevation angle between the U, V, and W axes and the YZ plane is 35.26 degrees.
- the azimuth measuring device detects a rotational angular velocity sensor ⁇ U , ⁇ V and ⁇ W around each axis and a gravitational acceleration g U , g V and g W in each axis direction in the UVW orthogonal coordinate system.
- a gravitational acceleration sensor a first stepping motor that positions the rotation angular velocity sensor and the gravity acceleration sensor around the X axis by rotating (60 ⁇ n) degrees (n is a natural number), and an rotation angular velocity about an axis orthogonal to the X axis
- a second stepping motor that positions the sensor and the gravitational acceleration sensor by oscillating ⁇ 35.26 degrees.
- the azimuth measuring device measures rotation angular velocities ⁇ U , ⁇ V , ⁇ W and gravitational accelerations g U , g V , g W around each axis, and measures the measured rotation angular velocities ⁇ U , ⁇ V , ⁇ W and gravitational acceleration.
- the coordinates of g U , g V , and g W are converted into rotation angular velocities ⁇ X , ⁇ Y , ⁇ Z and gravitational accelerations g X , g Y , g Z in an XYZ orthogonal coordinate system.
- the azimuth angle ⁇ is calculated based on the rotation angular velocities ⁇ X , ⁇ Y , ⁇ Z and the gravitational accelerations g X , g Y , g Z.
- the rotation angle is small and a larger space than that of the conventional azimuth measuring device is not required. Therefore, the size can be reduced as compared with the conventional uniaxial direction measuring device.
- the azimuth measuring apparatus disclosed in Japanese Patent Application Laid-Open No. 2008-215956 uses two stepping motors that are rotational drive sources. If the six directions can be directed with only one rotational drive source, the size can be further reduced.
- An object of the present invention is to provide a six-direction directing device capable of directing six directions with one rotational drive source.
- the six-direction directing device is installed in an XYZ orthogonal coordinate system.
- the six-direction directing device includes an inclined crank mechanism, a drive source, and a guide member.
- the inclined crank mechanism includes a shaft extending in the X-axis direction and a rotating member.
- the rotating member is rotatable around an inclined axis inclined with respect to the shaft, and is connected to the shaft.
- the drive source rotates the shaft around the X axis.
- the guide member is disposed around the X axis of the inclined crank mechanism, and has a zigzag periphery that is alternately bent in a mountain shape and a valley shape in the X axis direction every 60 degrees around the X axis.
- the rotating member includes a guide pin.
- the guide pins are erected around the inclined axis of the rotating member, contact the peripheral edge, circulate on the peripheral edge by the rotation of the shaft, and intersect the U axis, the V axis, and the W axis every 60 degrees around the X axis. Direct in either the + or-direction of the axis.
- the guide pin set up on the rotating member comes into contact with the peripheral edge of the guide member.
- the rotating member rotates around the X axis and also rotates around the tilt axis. Therefore, the guide pin circulates around the X axis while swinging in the X axis direction according to the angle formed by the X axis and the tilt axis, and the ⁇ directions of the U axis, V axis, and W axis intersecting each other (total 6 Direction).
- FIG. 4 is a YZ plan view showing a positional relationship between an XYZ coordinate system in which the six-direction directing device shown in FIG. 1 is installed and a UVW coordinate system for measuring rotation angular velocity and gravitational acceleration, and is viewed in the ⁇ X direction.
- FIG. 3 is a ZX plan view showing a positional relationship between an XYZ coordinate system in which the six-direction directing device shown in FIG.
- FIG. 1 is installed and a UVW coordinate system for measuring rotation angular velocity and gravitational acceleration, and viewed in the + Y direction. It is a side view of the guide in FIG. It is a side view of the guide on the opposite side to FIG. It is a perspective view of the guide and rotation member in FIG. It is a figure which shows the relationship between the rotation member in FIG. 7, and a slit. It is a figure which shows the relationship between a rotating member and a slit when seeing FIG. 1 from the apparatus front.
- FIG. 10 is a side view of the rotating member viewed from the upper left side in FIG. 9.
- FIG. 10 is a side view of the rotating member as viewed from diagonally below the left side in FIG. 9.
- FIG. 10 is a side view of the rotating member viewed from diagonally below the left side in FIG. 9.
- FIG. 10 is a side view of the rotating member viewed from directly below in FIG. 9.
- FIG. 10 is a side view of the rotating member viewed from diagonally below the right side in FIG. 9.
- FIG. 10 is a side view of the rotating member as seen from the upper right side in FIG. 9.
- It is a functional block diagram which shows the structure of the 6 direction directing apparatus shown in FIG. It is a figure for demonstrating the relationship between the direction which the 6 direction directing apparatus shown in FIG. It is a figure which shows the state of the rotating member in a 1st step among the operations
- FIG. 1 It is a figure which shows the state of the rotating member in a 3rd step among the operation
- FIG. 25 is a perspective view showing an external configuration of another example of the six-direction directing device, which is different from FIGS. 1, 23, and 24.
- FIG. 26 is a side view of the six-direction directing device shown in FIG. 25.
- FIG. 26 is a cross-sectional view of the rotating member in the vicinity of the guide pin in FIG. 25.
- 5 is a graph showing a relationship between an elevation angle ⁇ and an intersection angle ⁇ in the XYZ and UVW coordinate systems shown in FIGS. 4A and 4B.
- 6 is a graph showing a relationship between an error evaluation function f1 in the X-axis direction and an error evaluation function f2 in the Y- and Z-axis directions and an elevation angle ⁇ .
- the six-direction directing device 10 includes a stepping motor 14 that is a driving source, an inclined crank mechanism 22, and a guide member 20.
- the inclined crank mechanism 22 includes a shaft 221 connected to the motor shaft 16 of the stepping motor 14 and a rotating member 18 that can rotate around an inclined shaft 220 inclined with respect to the shaft 221.
- the guide member 20 is a spherical outer shell that is provided around the rotating member 18.
- the stepping motor 14 and the guide member 20 are fixed to the base 12.
- an example using a stepping motor as a drive source will be described, but an ultrasonic motor may be used instead of the stepping motor, and the type of motor is not particularly limited.
- the six-direction directing device 10 is installed in an XYZ orthogonal coordinate system.
- This coordinate system is an orthogonal coordinate system in which the X, Y, and Z axes form 90 degrees.
- the X axis is assigned on the motor shaft 16 of the stepping motor 14 and the XY plane is assigned in parallel with the surface of the base 12.
- the two shafts 221 of the inclined crank mechanism 22 are both arranged on the X axis.
- the rotating member 18 is disposed between the two shafts 221.
- An arm member 224 is disposed between each shaft 221 and the rotating member 18.
- the rotating member 18 is connected to each shaft 221 via the arm member 224.
- the two shafts 221 are rotatably supported by the guide member 20.
- the rotating member 18 includes a disk-shaped substrate 184 and an inner shell 181.
- the inner shell 181 is spherical and covers the upper and lower surfaces of the substrate 184.
- two shaft members 185 are formed on the side surface of the substrate 184.
- the two shaft members 185 are arranged on the same straight line passing through the center of the substrate 184.
- the arm member 224 includes a crank arm 222 and a boss 223.
- the boss 223 is formed at the end of the crank arm 222.
- the shaft member 185 is fitted into the boss 223. Accordingly, the substrate 184 is attached so as to be rotatable around the inclined axis 220 inclined by ⁇ degrees with respect to the shaft 221.
- Two guide pins 24 ⁇ / b> B and 24 ⁇ / b> D are arranged upright at a position orthogonal to the shaft member 185 on the side surface of the substrate 184.
- the guide pins 24B and 24D are rod-shaped members extending in the longitudinal direction.
- the guide pins 24B and 24D are orthogonal to the inclined axis 220.
- two guide pins 24 ⁇ / b> A and 24 ⁇ / b> C are arranged upright on the surface of the inner shell 181 on the normal line of the substrate 184 passing through the center of the substrate 184.
- the guide pins 24A and 24C are rod-shaped members extending in the longitudinal direction.
- Each of the guide pins 24A to 24D is orthogonal to the inclined axis 220.
- the guide pins 24A and 24C are disposed on the same straight line, and the guide pins 24B and 24D are disposed on the same straight line. Further, all the guide pins 24A to 24D are arranged on the same plane.
- the rotation angular velocity sensor 26 and the gravity acceleration sensor 28 are attached on the substrate 184.
- the directivity directions of these sensors 26 and 28 are both normal directions of the substrate 184. That is, it coincides with the axial direction of the guide pin 24A.
- the rotation angular velocity sensor 26 detects a rotation angular velocity component around the directing direction (that is, the axial direction of the guide pin 24A).
- the gravitational acceleration sensor 28 detects a gravitational acceleration component in the pointing direction.
- the six-direction directing device 10 is installed in the XYZ rectangular coordinate system.
- a UVW coordinate system is further assumed.
- 4A and 4B show the relationship between the XYZ orthogonal coordinate system and the UVW coordinate system.
- 4A shows a YZ plan view seen in the ⁇ X direction
- FIG. 4B shows a ZX plan view (right side view of FIG. 4A) seen in the + Y direction.
- the elevation angle that the U, V, and W axes make with the YZ plane is ⁇ degrees. That is, the angle ⁇ of the inclined shaft 220 with respect to the shaft 221 coincides with this elevation angle. Further, an intersection angle formed by the U, V, and W axes is ⁇ .
- the six axes + U, -U, + V, -V, + W, and -W are always spaced apart by 60 degrees on the YZ plane.
- the + U axis forms 60 degrees with respect to the ⁇ Z axis when projected perpendicularly to the YZ plane.
- the -U axis forms 60 degrees with respect to the + Z axis when projected perpendicular to the YZ plane.
- the + V axis forms 60 degrees with respect to the -Z axis when projected perpendicular to the YZ plane.
- the ⁇ V axis forms 60 degrees with respect to the + Z axis when projected perpendicular to the YZ plane.
- the + W axis coincides with the + Z axis when projected perpendicularly to the YZ plane.
- the ⁇ W axis coincides with the ⁇ Z axis when projected perpendicular to the YZ plane.
- the elevation angle ⁇ is preferably 30 to 40 degrees, and most preferably 35.26 degrees.
- the intersection angle ⁇ is most preferably 90 degrees.
- FIG. 5 is a side view of the guide member 20
- FIG. 6 is a side view on the opposite side to FIG.
- a hole 205 through which the two shafts 221 of the inclined crank mechanism 22 are passed is formed in a portion on the X axis of the guide member 20.
- Each of the two shafts 221 is inserted into a corresponding hole. Therefore, the rotating member 18 is supported by the guide member 20.
- a bearing (not shown) is disposed in the hole 205.
- the guide member 20 is further provided with a track slit 203 around the X axis around the entire center.
- the orbital slit 203 is a zigzag slit that is alternately bent in a mountain shape and a valley shape in the X-axis direction every 60 degrees around the X-axis.
- the guide member 20 includes a first guide member 201 and a second guide member 202.
- the first guide member 201 is disposed on the stepping motor 14 side with the track slit 203 as a boundary.
- the second guide member 202 is disposed on the opposite side of the stepping motor 14 with the track slit 203 as a boundary.
- the first guide member 201 includes a peripheral wall 2010 and a peripheral edge 41.
- the peripheral wall 2010 is disposed with the inclined crank mechanism 22 around the X axis and has an opening in the X axis direction.
- the peripheral edge 41 is the end of the peripheral wall 2010, and the mountain parts MO1 and the valley parts VA1 are alternately formed every 60 degrees around the X axis.
- the second guide member 202 includes a peripheral wall 2020 and a peripheral edge 42.
- the peripheral wall 2020 is disposed around the X axis and has an opening in the X axis direction.
- the peripheral edge 42 is an end of the peripheral wall 2020, and the peak MO2 and the valley VA2 are alternately formed every 60 degrees around the X axis.
- the track slit 203 is formed by the peripheral edge 41 of the first guide member and the peripheral edge 42 of the second guide portion 202.
- the peripheral edge 41 and the peripheral edge 42 are separated from each other and face each other.
- the crest MO2 and the trough VA2 on the peripheral edge 42 are shifted from the crest MO1 and the trough VA2 on the peripheral 41 by 60 degrees and are arranged around the X axis. Therefore, a gap is formed in a zigzag shape between the peripheral edges 41 and 42, and the track slit 203 is formed.
- the peaks of the peaks MO1 and MO2 and the valleys of the valleys VA1 and VA2 correspond to the U axis, the V axis, and the W axis, respectively.
- the valley bottom VA1 ⁇ V and peak sum MO1 + V of the peripheral edge 41 and the peak sum MO2 ⁇ V and valley bottom VA2 + V of the peripheral edge 42 all correspond to the V axis.
- the V-axis passes through the orbital slit 203 at the bending point formed by the valley bottom VA1 ⁇ V and the mountain peak MO2 ⁇ V and the bending point formed by the mountain peak MO1 + V and the valley bottom VA2 + V.
- summit MO1 + U , the valley bottom VA2 + U , the summit MO2 ⁇ U and the valley bottom VA1 ⁇ U correspond to the U axis
- summit MO1 + W , the valley bottom VA2 + W , the summit MO2 ⁇ W and the valley bottom VA1 ⁇ W correspond to the W axis.
- the four guide pins 24 A to 24 D arranged upright on the rotating member 18 are inserted into the track slit 203.
- Each guide pin 24A-24D contacts the peripheral edge 41 and / or 42.
- the rotating member 18 connected to the shaft 221 also rotates.
- the guide pins 24A to 24D circulate on the track slit 203 while being in contact with the peripheral edges 41 and 42.
- the guide pins 24A to 24D circulate on the peripheral edge 41 and / or the peripheral edge 42.
- the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 disposed on the rotating member 18 have six directions ( ⁇ U direction, ⁇ V direction, ⁇ W direction).
- the guide member 20 is fixed to the base 12 at such a height that the guide pins 24A to 24D do not hit the base 12 when the guide pins 24A to 24D go around the track slit 203.
- FIG. 7 is a view (top view) of the inclined crank mechanism 22 and the guide member 20 of the six-direction directing device 10 shown in FIG. 1 viewed from directly above (that is, in the + Z direction), and FIG. 8 is easy to explain.
- FIG. 8 is a top view showing only the rotating member 18 and the track slit 203 in FIG.
- each bending point of the zigzag track slit 203 is referred to as the summit MO1 + U , MO1 + V , MO1 + W and valley bottom VA1 ⁇ U , VA1 ⁇ V , VA1 ⁇ W of the peripheral edge 41 of the guide member 201. To do.
- the width of the track slit 203 in the drawings is smaller than that of the guide pins 24A to 24D. However, as described above, the width of the track slit 203 is actually larger than that of the guide pins 24A to 24D. .
- all of the four guide pins 24A to 24D are inserted into the track slit 203.
- the tip of the guide pin 24A is oriented in the ⁇ W direction. That is, in the state of FIGS. 7 and 8, the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 are directed in the ⁇ W direction.
- FIG. 9 is a diagram showing the rotating member 18 and the track slit 203 when the six-direction directing device 10 is viewed from the front (that is, viewed in the ⁇ X direction).
- FIGS. 10 to 14 are views showing the rotating member 18 and the orbital slit 203 viewed in a direction inclined by (60 ⁇ n) degrees (n is 1 to 6) around the X axis as shown in FIG. .
- the six-direction directing device 10 further includes an information processing device 30 including a computer or the like.
- the information processing apparatus 30 includes a motor control unit 32, a rotation angular velocity measurement unit 36, a gravitational acceleration measurement unit 38, a rotation angular velocity coordinate conversion unit 40, a gravity acceleration coordinate conversion unit 46, and an azimuth angle calculation unit 44. .
- the motor control unit 32 controls the stepping motor 14.
- the rotation angular velocity measuring unit 36 measures the rotation angular velocity components ⁇ U , ⁇ V and ⁇ W detected by the rotation angular velocity sensor 26.
- the gravitational acceleration measuring unit 38 measures the gravitational acceleration components g U , g V and g W detected by the gravitational acceleration sensor 28.
- the rotation angular velocity coordinate conversion unit 40 converts the rotation angular velocity components ⁇ U , ⁇ V and ⁇ W measured by the rotation angular velocity measurement unit 36 into the rotation angular velocity components ⁇ X , ⁇ Y and ⁇ Z according to the following equation (4). To do.
- the gravitational acceleration coordinate conversion unit 46 converts the gravitational acceleration components g U , g V, and g W measured by the gravitational acceleration measurement unit 38 into the gravitational acceleration components g X , g Y, and g Z according to the following equation (5). To do.
- the azimuth angle calculation unit 44 includes the rotation angular velocity components ⁇ X , ⁇ Y, and ⁇ Z obtained by the rotation angular velocity coordinate conversion unit 40 and the gravity acceleration components g X , g Y, and g obtained by the gravity acceleration coordinate conversion unit 46. Based on Z , the azimuth angle ⁇ is calculated by the following equation (6).
- FIG. 16 is a sequence diagram showing an example of the operation of the six-direction directing device 10.
- the motor control unit 32 controls the stepping motor 14 to change the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 from “ ⁇ W” ⁇ “+ V” ⁇ “ ⁇ U” ⁇ “+ W” ⁇
- the direction is directed in the order of “ ⁇ V” ⁇ “+ U” (S1 to S6). If the motor control unit 32 rotates the shaft 221 240 degrees counterclockwise when viewed from the front of the apparatus (that is, in the ⁇ X direction) in each of steps S1 to S6, the shaft 221, the rotating member 18, the guide member By interacting with 20, each sensor 26 and 28 can be directed in a corresponding direction at each step.
- the sensors 26 and 28 can be oriented in six directions ( ⁇ U direction, ⁇ V direction, and ⁇ W direction) by rotating only one axis with one drive source.
- the operation of the six-direction directing device 10 will be described in detail with reference to FIGS.
- the tip portion of the guide pin 24A that matches the directivity direction of each sensor 26 and 28 is circled.
- step S1 guide pin 24A is located at valley bottom VA1- W of guide member 201, and the tip thereof points in the -W direction.
- the guide pin 24A coincides with the directing directions of the rotation angular velocity sensor 26 and the gravity acceleration sensor 28. Therefore, in FIG. 17, the rotation angular velocity sensor 26 and the gravity acceleration sensor 28 are directed in the ⁇ W direction.
- the rotation angular velocity measuring unit 36 calculates the rotation angular velocity component ⁇ W detected by the rotation angular velocity sensor 26 for a predetermined measurement time (for example, 30 seconds to 1 minute) for a predetermined sampling period (for example, 1 to 10 mm). Every second), and the values are sequentially stored in a memory (not shown).
- the gravitational acceleration measuring unit 38 samples the gravitational acceleration component g W detected by the gravitational acceleration sensor 28 every predetermined sampling period (for example, 1 to 10 milliseconds), and sequentially stores the value in the memory. .
- step S2 in order to sample the rotational angular velocity component ⁇ V and the gravitational acceleration component g V in the + V direction, the guide pins 24A to 24D are rotated on the track slit 203, and the guide pin 24A is moved from the valley bottom VA1 -W. Move to MO1 + V.
- the motor control unit 32 controls the stepping motor 14 to rotate the shaft 221 240 degrees counterclockwise when viewed from the front of the six-direction directing device 10.
- the guide pin 24A moves on the track slit 203 and reaches the summit MO1 + V , and the sensors 26 and 28 are directed in the + V direction.
- this operation will be described in detail.
- the tilt axis 220 is orthogonal to the W axis. From this state, when the shaft 221 is rotated 240 degrees counterclockwise when viewed from the front of the apparatus, the inclined shaft 220 stops in a state orthogonal to the V-axis (see FIG. 18).
- the rotating member 18 rotates counterclockwise around the X axis together with the shaft 221. Rotate 240 degrees. In this case, the tip of the guide pin 24A is directed in the ⁇ V direction.
- the rotating member 18 can rotate around the tilt axis 220. Therefore, the guide pin 24 ⁇ / b> A that is orthogonal to the tilt axis 220 rotates around the tilt axis 220. Since the inclined shaft 220 is inclined with respect to the X axis (shaft 221) by ⁇ degrees (35.26 degrees in this example), the rotation of the shaft 221 causes the guide pin 24A to move in the range of ⁇ ⁇ degrees in the X axis direction. Can be swung.
- the guide pin 24A can freely rotate around the X axis by the rotation of the shaft 221, and can swing within the range of ⁇ ⁇ degrees by rotating around the inclined axis 220. Therefore, the guide pin 24A can be oriented in the + and ⁇ directions of the U axis, the V axis, and the W axis that have the relationship shown in FIGS. 4A and 4B with the XYZ orthogonal coordinate system.
- the orbital slit 203 composed of the peripheral edges 41 and 42 of the guide member 20 moves the guide pin 24A on the above-mentioned U axis, V axis and W axis, and its tip is in six directions ( ⁇ U direction, ⁇ V direction and It plays a role of positioning toward ( ⁇ W direction).
- the orbital slit is not a zigzag shape as in the present embodiment but is a straight line parallel to the X axis
- the guide pin 24A only swings along the X axis by the rotation of the shaft 221. It is.
- the orbital slit 203 has a mountain shape (peak top MO1 + U , MO1 + V and MO1 + W ) and a valley shape (valley bottom VA1 -U , VA1 -V , VA1) every 60 degrees around the X axis. -W ) zigzag bent alternately. That is, the trajectory is formed obliquely with respect to the X axis. Therefore, the guide pin 24A not only swings in the X-axis direction, but can circulate around the X-axis.
- the summit MO1 + U and the valley bottom VA ⁇ U correspond to the U axis
- the summit MO1 + V and the valley bottom VA ⁇ V correspond to the V axis
- the summit MO1 + W and the valley bottom VA ⁇ W correspond to the W axis. Therefore, when the shaft 221 rotates, the guide pin 24A swings in the range of ⁇ ⁇ degrees in the X-axis direction while circling around the X-axis, and when reaching the peak and valley bottom, the U-axis, V-axis, W Arranged on the axis.
- step S2 while the shaft 221 rotates, the guide pin 24A makes contact with the peripheral edge 41 while moving on the track slit 203 from the valley bottom VA1- W toward the peak MO1 + V. Moving. At this time, the guide pin 24A rotates counterclockwise when the shaft 221 rotates and the X axis is seen from the front of the apparatus (in the ⁇ X direction). Furthermore, the guide pin 24 ⁇ / b> A receives the force from the peripheral edge 41 because it contacts the peripheral edge 41 constituting the track slit 203.
- the rotating member 18 rotates clockwise around the tilt axis 220 when viewed from the front of the apparatus, and the tip of the guide pin 24A swings from the ⁇ X direction to the + X direction. That is, the guide pin 24A swings in the X-axis direction while rotating around the X-axis by the track slit 203.
- the guide pin 24A rotates 60 degrees counterclockwise around the X axis by the track slit 203. Further, when the guide pin 24 ⁇ / b> A comes into contact with the peripheral edge 41, the rotating member 18 is given a force that rotates clockwise around the inclination axis 220 and rotates 180 degrees around the inclination axis 220 clockwise. As a result, the guide pin 24A reaches the summit MO1 + V as shown in FIG. At this time, the guide pin 24A is disposed on the V-axis, and the tip thereof points in the + V direction. That is, each sensor 26 and 28 is directed in the + V direction.
- the rotation angular velocity measuring unit 36 samples the rotation angular velocity component ⁇ V and stores it in the memory, similarly to step S1.
- the gravitational acceleration measuring unit 38 also samples the gravitational acceleration component g V and stores it in the memory.
- step S2 the shaft 221 is rotated by 240 degrees counterclockwise, and the tip of the guide pin 24A is moved in each direction ( ⁇ U direction, ⁇ V direction, ⁇ W) on the UVW coordinates. Direction).
- step S3 the shaft 221 is rotated 240 degrees counterclockwise as viewed from the front of the apparatus from the state shown in FIG.
- the guide pin 24A reaches the valley bottom VA1- U of the track slit 203 as shown in FIG.
- the guide pin 24A is disposed on the U-axis, and the tip thereof is directed in the ⁇ U direction.
- the rotation angular velocity measurement unit 36 samples the rotation angular velocity component ⁇ U
- the gravity acceleration measurement unit 38 also samples the gravity acceleration component g U.
- the rotation angular velocity measurement unit 36 samples the rotation angular velocity component ⁇ W again, and the gravity acceleration measurement unit 38 also samples the gravity acceleration component g W. That is, the six-direction directing device 10 measures the rotation angular velocity ⁇ W and the gravitational acceleration component g W in both the + W and ⁇ W directions on the W axis.
- step S5 the shaft 221 is rotated 240 degrees counterclockwise as viewed from the front of the apparatus from the state shown in FIG.
- the guide pin 24A swings 2 ⁇ degrees in the ⁇ X direction, and rotates 60 degrees counterclockwise around the X axis when viewed from the front of the apparatus. Therefore, as shown in FIG. 21, the guide pin 24A moves from the peak MO1 + W to the valley bottom VA1 ⁇ V along the track slit 203.
- the guide pin 24A is disposed on the V-axis, and the tip thereof points in the -V direction.
- the rotation angular velocity measurement unit 36 samples the rotation angular velocity component ⁇ V again, and the gravity acceleration measurement unit 38 also samples the gravity acceleration component g V.
- step S6 the shaft 221 is rotated 240 degrees counterclockwise from the state of FIG.
- the guide pin 24A rotates 60 degrees counterclockwise around the X axis and swings 2 ⁇ degrees in the + X direction.
- the guide pin 24A reaches the summit MO1 + U from the valley bottom VA1- V .
- the guide pin 24A is disposed on the U-axis, and the tip thereof points in the + U direction.
- the rotation angular velocity measurement unit 36 samples the rotation angular velocity component ⁇ U again, and the gravity acceleration measurement unit 38 also samples the gravity acceleration component g U.
- the rotation angular velocity measuring unit 36 calculates the rotation angular velocities ⁇ X , ⁇ Y , and ⁇ Z in the UVW orthogonal coordinate system by using the data sampled in steps S1 to S6 by the least square method or the arithmetic mean.
- the gravitational acceleration measuring unit 38 calculates gravitational accelerations g X , g Y , and g Z in the UVW orthogonal coordinate system by a least square method, an arithmetic mean, or the like.
- the rotation angular velocity coordinate conversion unit 40 uses the rotation angular velocity ( ⁇ U , ⁇ V , ⁇ W ) calculated by the rotation angular velocity measurement unit 36 as the rotation angular velocity ( ⁇ X , ⁇ Y , ⁇ Z ) in the XYZ orthogonal coordinate system. Convert coordinates to.
- the gravitational acceleration coordinate conversion unit 46 converts the gravitational acceleration (g U , g V , g W ) calculated by the gravitational acceleration measuring unit 38 into the gravitational acceleration (g X , g Y , g Z ) in the XYZ orthogonal coordinate system. Convert coordinates.
- the azimuth angle calculation unit 44 includes the rotation angular velocity ( ⁇ X , ⁇ Y , ⁇ Z ) and gravitational acceleration (g X , g Y , g) obtained by the rotation angular velocity coordinate conversion unit 40 and the gravity acceleration coordinate conversion unit 46.
- the azimuth angle ⁇ is calculated based on Z ).
- the guide pin 24 ⁇ / b> A can be moved in six directions with only one rotational drive source by the rotating member 18, the guide pin 24 ⁇ / b> A, and the peripheral edge 41 and the peripheral edge 42 forming the zigzag track slit 203.
- ⁇ U direction, ⁇ V direction, and ⁇ W direction) can be directed in six directions.
- the rotation angle is small and does not require a large space for rotation.
- it since it can operate with one rotational drive source, it can be further downsized.
- the elevation angle ⁇ 35.26 degrees, but the elevation angle ⁇ is not limited to this and may be 30 to 40 degrees.
- the angle ⁇ may be 80 to 100 degrees.
- the six-direction directing device 10 does not necessarily need to include both the first and second guide members 201 and 202.
- the six-direction directing device 10 may not include the second guide member 202 but may include only the first guide member 201, or vice versa.
- the peripheral edge 41 of the first guide member 201 forms a zigzag track. That is, the guide pins 24A to 24D come into contact with the peripheral edge 41 and go around the X axis.
- the guide pin 24A and the sensors 26 and 28 can be moved only by the rotation of the shaft 221. It can be directed in six directions ( ⁇ U direction, ⁇ V direction, ⁇ W direction).
- ⁇ U direction, ⁇ V direction, ⁇ W direction the guide member 20 is composed of the first and second guide members 201 and 202, it is sufficient to have at least one guide pin. That is, even when the guide pins 24B to 24D are not provided and only the guide pin 24A is erected on the rotating member 18, the guide pin 24A can move on the track slit 203 while contacting the peripheral edges 41 and 42.
- the rotating member 18 When the rotating member 18 has four guide pins (guide pins 24A to 24D), the crests of the guide members 201 and 202 are not necessarily arranged on the UVW axes.
- the rotating member 18 when the six-direction directing device 10 does not include the second guide member 202 but includes only the first guide member 201 as the guide member 20, the rotating member 18 includes four guide pins 24A to 24D.
- the summits MO1 + U , MO1 + V and MO1 + W of each mountain part MO1 may be lower than those in FIG. It does not have to correspond to.
- each peak MO1 has a trapezoidal shape, and the width gradually decreases from the valley VA1 toward the peak.
- valley bottoms VA1- U , VA1- V , VA1- W correspond to the U-axis, V-axis, and W-axis. Even with such a configuration, the guide pin 24A can point in six directions ( ⁇ U direction, ⁇ V direction, ⁇ W direction).
- the peripheral edge 41 of the first guide member 201 has three peak parts MO1 and three valley parts VA1, but there may be two peak parts and two valley parts. It is only necessary that the two peaks are arranged every 60 degrees, and the two valleys are arranged every 60 degrees.
- the shaft 221 is connected to the rotating member 18 via the crank arm 222 to constitute the inclined crank mechanism 22, but the shaft 221, the crank arm 222, and the crank pin disposed on the inclined shaft 220 are used.
- the crank mechanism 22 may be configured by the crankshaft configured and the rotation member 18 into which the crankpin of the crankshaft is inserted and rotatable around the crankpin (that is, the inclined shaft 220).
- the inclined crank mechanism 22 includes the two shafts 221, but the number of the shafts 221 may be one.
- the six-direction directing device 10A includes a stepping motor 14, an inclined crank mechanism 22A, and a guide member 20A.
- Stepping motor 14 is housed in motor case 500 and fixed to the inner surface of motor case 500.
- the motor case 500 is fixed to the base 12.
- a shaft 221 is attached to the end of the stepping motor 14.
- the guide member 20A is disposed on the opposite end side to the stepping motor 14 with the inclined crank mechanism 22 interposed therebetween.
- the guide member 20A has a cylindrical shape and has openings at both ends in the X-axis direction.
- the guide member 20 ⁇ / b> A is fixed to the base 12.
- the guide member 20A has a cylindrical peripheral wall 2020A and a peripheral edge 42A that is an end of the peripheral wall 2020A on the inclined crank mechanism 22 side.
- mountain portions MO2 and other portions VA2 are alternately formed every 60 degrees around the X axis.
- An opening 2030 is formed at the end of the peripheral wall 2020A opposite to the peripheral edge 42A. A plurality of wires connected to the inclined crank mechanism 22A are passed through the opening 2030.
- the guide member 20A corresponds to the second guide member 202 described above.
- the summits of the three peak portions MO2 on the peripheral edge 42A do not correspond to the UVW axis, and are trapezoidal.
- each of the three valleys VA2 of the peripheral edge 42A corresponds to each UWV axis.
- the inclined crank mechanism 22A includes a shaft 221, an arm member 224, and a rotating member 18A.
- Rotating member 18A rotates around an inclined axis inclined by ⁇ degrees with respect to shaft 221 in the same manner as rotating member 18.
- the rotating member 18A is attached to the shaft 221 via the arm member 224.
- Rotating member 18A includes a disk-shaped substrate 184 as with rotating member 18.
- the rotating member 18A includes an annular member 181A instead of the inner shell 181.
- the annular member 181A is formed on the substrate 184 and is orthogonal to the substrate 184.
- one shaft member 185 is formed on the side surface of the substrate 184, and the shaft member 185 is inserted into the hole formed at the tip of the arm member 224. Thereby, the rotating member 18A is supported to be rotatable around the tilt axis.
- Two guide pins 24B and 24D are erected on the side surface of the substrate 184.
- the guide pins 24B and 24D are arranged on a straight line passing through the center of the substrate 184.
- the guide pins 24B and 24D are orthogonal to the inclined axis 220.
- two guide pins 24A and 24D are set up on the normal line of the substrate 184 passing through the center of the substrate 184.
- the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 are mounted on the substrate 184 as in FIG.
- the directivity directions of these sensors 26 and 28 coincide with the axial direction of the guide pin 24A. That is, the guide pin 24A functions as a directivity pin that indicates the directivity direction of the sensors 26 and 28.
- the inclined crank mechanism 22A includes only one shaft 221. That is, the inclined crank mechanism 22A includes the shaft 221 only on the stepping motor 14 side, and does not include the shaft 221 on the guide member 20A side.
- the 6-direction directing device 10A further includes a cradle 510 and an elastic member 520.
- the cradle 510 is disposed on the end surface of the motor case 500.
- the cradle 510 is a cylinder, and the shaft 221 is inserted therein.
- the cradle 510 is fixed to the motor case 500. Therefore, when the shaft 221 is rotated by the stepping motor 14, the cradle 510 does not rotate.
- the elastic member 520 is a spiral spring and is disposed between the cradle 510 and the arm member 224. A shaft 221 is inserted into the elastic member 520. The elastic member 520 applies a force in the direction of the guide member 20A to the rotating member 18A via the arm member 224. The elastic member 520 pushes the rotating member 18A in the direction of the guide member 20A, so that it is stably supported by one shaft 221 even if the shaft 221 is not disposed on the guide member 20A side.
- the rotating member 18A rotates while being pressed against the guide member 20A by the elastic member 520. Therefore, the rotating member 18 ⁇ / b> A is stably supported even with one shaft 221. Since the shaft 221 can be made one and the guide member can be made one, the 6-direction directing device 10A can be downsized as compared with the 6-direction directing device 10. Furthermore, it is easy to secure a space for arranging wirings connected to the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28.
- the peripheral edge 42A has trapezoidal peaks MO and valleys VA that are alternately arranged every 60 degrees.
- the peripheral edge 42A further has a recess 410 at the end of the upper side (that is, the peak) of the peak MO.
- Guide members 24B and 24D fit into the recess 410.
- the guide pin 24D and the guide pin 24B arranged coaxially with the guide pin 24D are such that the guide pin 24A is accurately on the U axis, the V axis, and the W axis. It functions as an auxiliary pin to be disposed on the.
- the guide pins 24B and 24D are referred to as auxiliary pins 24B and 24D
- the guide pin 24A is referred to as a directional pin 24A.
- the depression 410 is formed at a position where any of the auxiliary pins 24B and 24D comes into contact with the peripheral edge 42A when the directional pin 24A is disposed on any of the U axis, the V axis, and the W axis. More specifically, the recess 410 has auxiliary pins 24B and 24D when the tip of the directing pin 24A points to one of the + U axis, ⁇ U axis, + V axis, ⁇ V axis, + W axis, and ⁇ W axis. Is formed at a position in contact with the peripheral edge 42A.
- the rotating member 18A rotates around the X axis and the inclined axis 220.
- the tip of the directing pin 24A is directed in the + U-axis direction
- one of the auxiliary pins 24B and 24D fits into the recess 410. Therefore, the directing pin 24A can accurately direct the + U axis.
- the directional pin 24A is disposed on any of the U axis, the V axis, and the W axis, any one of the auxiliary pins 24B and 24D is brought into the depression 410 by the force applied from the elastic member 520. Fit. Therefore, the pointing accuracy of the pointing pin 24A is improved.
- the auxiliary pins 24B and 24D easily come out of the recess 410 when the stepping motor 14 rotates the shaft 221.
- the auxiliary pins 24B and 24D go around the periphery 42A again.
- the base of the auxiliary pin 24D is inserted into the bearing 530.
- the bearing 530 is fixed inside the side surface of the substrate 184.
- the auxiliary pin 24D is attached to the rotating member 18A so as to be rotatable around the axis of the auxiliary pin 24D.
- the auxiliary pin 24D moves on the peripheral edge 42A while being in contact with the peripheral edge 42A. Since the auxiliary pin 24D rotates around the axis of the auxiliary pin 24D, friction between the auxiliary pin 24D and the peripheral edge 42A can be suppressed.
- the base of the auxiliary pin 24B is inserted into the bearing, and is attached to the rotating member 18A so as to be rotatable around the axis of the auxiliary pin 24B.
- the peripheral edges 41 and 42 of the guide member 20 have slits as tracks, but the tracks may have a configuration other than slits.
- a guide member 20 having a zigzag groove similar to the track slit 203 described above is installed around the inner surface of the guide in which the slit is not formed.
- the groove may be used as a track. Even in such a case, the above-described operation can be realized if the tip of the guide pin 24A comes into contact with the peripheral edge of the groove (track).
- a rail may be used in place of the track slit 203, and the periphery formed on the top of the rail may be used as the track. That is, the guide member 20 is not particularly limited as long as the guide member 24 has a peripheral edge that contacts when the guide pin 24 goes around the X axis.
- the shape of the track slit 203 (that is, the shape of the peripheral edge 41 of the guide member 201) viewed from the front of the apparatus is a circle, but the shape of the track slit 203 is a shape other than a circle. Also good.
- the shape of the orbital slit 203 as viewed from the front of the apparatus may be a hexagonal shape, and other trajectories may be formed as long as orbits are alternately bent in a mountain shape and a valley shape every 60 degrees around the X axis. It may be a shape.
- the elastic member is not limited to a spiral spring, and a plate spring or rubber may be used. Further, an elastic member may be disposed on the guide member 20A side, and the rotating member 18A may be pulled by the elastic member and pressed against the peripheral edge 42A. In short, the elastic member is not particularly limited as long as it applies a force to the rotating member in the direction of the guide member.
- the auxiliary pin 24B and 24D are recessed at a position where they contact the peripheral edge 42A. 410 was formed.
- the position of the recess 410 is not limited to this example.
- the guide pin 24A is any of the U-axis, V-axis, and W-axis.
- a recess When arranged on the axis, a recess may be formed at a position where the guide pin 24A and the guide pin 24C arranged around the inclined axis 220 are separated by 180 degrees and the peripheral edge 42A.
- a recess may be formed at a position where the guide pin 24A and the peripheral edge 42A contact each other.
- the rotating member 18 includes a plurality of guide pins 24A to 24D arranged 90 degrees or 180 degrees apart from each other around the inclined axis 220, the guide pin 24A can select any of the U axis, the V axis, and the W axis. If a depression is formed at a position where any one of the guide pins 24A to 24D is in contact with the peripheral edge 42A when pointing, the above-described effect is obtained.
- the elevation angle ⁇ is preferably 30 to 40 degrees, more preferably 35.26 degrees, and the intersection angle ⁇ is most preferably 90 degrees.
- intersection angle ⁇ of the U, V, and W axes is expressed by the following equation (8) from the inner product between the column vectors.
- Equation (9) A is a coordinate transformation matrix from the XYZ orthogonal coordinate system to the UVW coordinate system, and
- Equation (9) the gravitational acceleration components in the X, Y, and Z axis directions. That is, if the gravitational acceleration components in the X, Y, and Z axis directions are g X , g Y , and g Z , the gravitational acceleration components g U , g V , and g W in the U, V, and W axis directions are expressed by Equation (9). It is expressed in the same way.
- the inverse matrix is a transposed matrix of the original matrix, but in this case, unlike the normal coordinate transformation matrix, the inverse matrix C is a transposed matrix of the matrix A. is not.
- intersection angle ⁇ in this case is expressed by the following equation (19) from the equation (8).
- the UVW coordinate system in this case is an orthogonal coordinate system.
- the posture of the six-direction directing device 10 is represented by the Euler angles (azimuth angle ⁇ , pitch angle ⁇ , and roll angle ⁇ ) shown in FIG.
- the azimuth angle ⁇ is directed to the vertical direction Down (or the Z-axis + direction) and positive in the clockwise direction, and north direction North and X-axis + direction (or east direction East and Y-axis + direction). It is an angle formed by.
- the pitch angle ⁇ is directed to the east direction East (or the Y axis + direction) and positive in the clockwise direction, and the north direction North and the X axis + direction (or the vertical direction Down and the Z axis + direction).
- the roll angle ⁇ faces north direction North (or X axis + direction) and is positive in the clockwise direction, east direction East and Y axis + direction (or vertical direction Down and Z axis + direction). It is an angle formed by.
- the roll angle ⁇ , the pitch angle ⁇ , and the azimuth angle ⁇ are expressed by the following equation (22).
- the latitude ⁇ of the place where the six-direction directing device 10 is installed is expressed by the following equation (23).
- the information processing apparatus 30 shown in FIG. 15 may further include a roll angle calculation unit, a pitch angle calculation unit, and a latitude calculation unit.
- the azimuth angle error ⁇ changes according to the posture (azimuth angle ⁇ and pitch angle ⁇ ) of the six-direction directing device 10.
- 33 and 34 show the results of plotting the elevation angle ⁇ on the horizontal axis and the azimuth error evaluation function f on the vertical axis.
- the error is relatively small when the elevation angle ⁇ is in the range of 30 to 40 degrees.
- the azimuth angle error ⁇ in this case is always constant without being affected by the posture of the six-direction directing device 10.
- the elevation angle ⁇ of the UVW coordinate system is preferably in the range of 30 to 40 degrees.
- the intersection angle ⁇ at this time is in the range of about 100 to 80 degrees from FIG.
- the elevation angle ⁇ is most preferably 35.26 degrees.
- the intersection angle ⁇ at this time is 90 degrees, and the UVW coordinate system is an orthogonal coordinate system.
- the measurement error is the same regardless of the relative positional relationship with the XYZ coordinate system, but the envelope in the longitudinal direction (X-axis direction) in this case will be described below. .
- the tip positions i U , i V , i W of the unit vectors of the U, V, and W axes are expressed by the following expression (27) in the XYZ coordinate system.
- FIG. 36 shows the result of plotting the elevation angle ⁇ on the horizontal axis and L / R of the formula (28) on the vertical axis.
- ⁇ 0
- the W axis is in the YZ plane and coincides with the Z axis.
- the tip positions i U , i V , i W of the unit vectors of the U, V, and W axes are expressed by the following equation (30) from equation (27). These correspond to the first column, the second column, and the third column of Equation (18).
- the rotation angular velocity sensor. 26 and the gravitational acceleration sensor 28 can be directed in all axial directions ( ⁇ U direction, ⁇ V direction, ⁇ W direction: 6 directions in total) of the UVW coordinate system. Furthermore, since the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 are swung only by ⁇ 35.26 degrees, the rotation angle is small and a large space is not required for rotation. As a result, the size can be reduced.
- the UVW coordinate system is an orthogonal coordinate system and the elevation angle ⁇ is 35.26 degrees
- the measurement errors of the rotational angular velocity components ⁇ X , ⁇ Y, and ⁇ Z in the XYZ orthogonal coordinate system are the same, and the XYZ orthogonal
- the measurement errors of the gravitational acceleration components g X , g Y and g Z in the coordinate system are the same.
- the measurement error of the azimuth angle ⁇ is reduced without depending on the posture of the six-direction directing device 10.
- the six-direction directing device 10 may be installed in an arbitrary posture, it is possible to easily measure the azimuth without requiring any reference such as a horizontal plane.
- the posture of the installed six-direction directing device 10 can also be measured.
- the rotational angular velocity ( ⁇ U , ⁇ V , ⁇ W ) and gravitational acceleration (g U , g V , g W ) measured in both + and ⁇ directions are averaged.
- a bias peculiar to the direction directing device 10 is canceled out, and a measurement error can be reduced.
- the six-direction directing device samples each rotation speed component and gravity acceleration component on the U axis, the V axis, and the W axis, respectively.
- the six-direction directing device may sample with only two axes of the U axis, the V axis, and the W axis, or may sample with only one of the axes.
- the six-direction directing device 10 rotates counterclockwise when the shaft 221 is viewed from the front of the device (that is, in the ⁇ X direction), but rotates clockwise. Also good.
- the six-direction directing device includes the rotation angular velocity sensor 26 and the gravitational acceleration sensor 28 and functions as an orientation measuring device.
- the six-direction directing device can be used for applications other than the orientation measuring device.
- a six-direction directing device can be used as a monitoring camera capable of photographing six directions.
- a six-direction directing device can also be used as a receiving antenna.
- the six-direction directing device according to the present invention can be used for all applications that need to direct devices installed on rotating members such as sensors, cameras, and antennas in six directions.
- the six-direction directing device can also be used as a pseudo zero gravity state generating device.
Landscapes
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
Description
ただし、谷底VA1-U、VA1-V、VA1-Wは、U軸、V軸及びW軸と対応している。このような構成であっても、ガイドピン24Aは、6方向(±U方向、±V方向、±W方向)を指向できる。
Claims (9)
- XYZ直交座標系内に設置された6方向指向装置であって、
X軸方向に延びたシャフトと、前記シャフトに対して傾斜した傾斜軸周りを回転可能であり前記シャフトと連結された回転部材とを含む傾斜クランク機構と、
前記シャフトをX軸周りに回転する駆動源と、
前記傾斜クランク機構のX軸周りに配置され、X軸周りの60度おきに山状及び谷状に交互に曲折したジグザグ状の周縁を有するガイド部材とを備え、
前記回転部材は、
前記回転部材の傾斜軸周りに配置され、前記周縁と接触し、前記シャフトの回転により前記周縁上を周回し、X軸周りの60度おきに、互いに交わるU軸、V軸及びW軸の+及び-方向のいずれかを指向するガイドピンを備えることを特徴とする6方向指向装置。 - 請求項1に記載の6方向指向装置であって、
前記ガイド部材は、
前記X軸周りに配置される周壁を備え、
前記周縁は、前記周壁の端であって、X軸周りの60度おきに交互に配置された山部及び谷部を有することを特徴とする6方向指向装置。 - 請求項1に記載の6方向指向装置であって、
前記ガイド部材は、前記回転部材を挟んで前記駆動源と反対側に配置され、
前記6方向指向装置はさらに、
前記回転部材に対して前記ガイド部材の方向に力を付与する弾性部材を備えることを特徴とする、6方向指向装置。 - 請求項3に記載の6方向指向装置はさらに、
互いに傾斜軸周りに90度又は180度離れて配置される複数の前記ガイドピンを備え、
前記周縁はさらに、
前記ガイドピンが前記U軸、V軸及びW軸のいずれかを指向するときに前記複数のガイドピンのいずれかが前記周縁と接触する位置に、くぼみを有することを特徴とする、6方向指向装置。 - 請求項1に記載の6方向指向装置であって、
前記傾斜軸は、前記シャフトに対してα度(α=30~40)傾斜し、
前記U軸、V軸及びW軸は、互いにβ度(β=80~100)で交わることを特徴とする6方向指向装置。 - 請求項5に記載の6方向指向装置であってさらに、
前記回転部材に配設され、U軸、V軸及びW軸周りの自転角速度成分ωU、ωV及びωWを検出する自転角速度センサと、
前記回転部材に配設され、U軸、V軸及びW軸方向の重力加速度成分gU、gV及びgWを検出する重力加速度センサと、
前記回転軸の回転により前記ガイドピンが前記軌道上を周回してU軸、V軸、W軸の+及び-方向を指向したときに前記自転角速度センサにより検出された自転角速度成分ωU、ωV及びωWと、前記重力加速度センサにより検出された重力加速度成分gU、gV及びgWとを計測する計測手段と、
前記計測された自転角速度成分ωU、ωV及びωWを自転角速度成分ωX、ωY及びωZに座標変換する自転角速度座標変換手段と、
前記計測された重力加速度成分gU、gV及びgWを重力加速度成分gX、gY及びgZに座標変換する重力加速度座標変換手段と、
得られた自転角速度成分ωX、ωY及びωZ及び重力加速度成分gX、gY及びgZとに基づいて、方位角ψを算出する方位角算出手段とを備えることを特徴とする6方向指向装置。 - 請求項7に記載の6方向指向装置であって、
α=35.26、β=90であることを特徴とする6方向指向装置。 - 請求項1に記載の6方向指向装置であってさらに、
少なくとも2本の前記ガイドピンを備え、
各ガイドピンは前記傾斜軸まわりに180度離間して同一直線上に配設されることを特徴とする6方向指向装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010534681A JP5377507B2 (ja) | 2008-10-20 | 2009-10-19 | 6方向指向装置 |
US13/125,281 US8528220B2 (en) | 2008-10-20 | 2009-10-19 | Six-direction indicator |
EP09821778.9A EP2341314B1 (en) | 2008-10-20 | 2009-10-19 | Six-direction orienting device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008270244 | 2008-10-20 | ||
JP2008-270244 | 2008-10-20 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2010047078A1 true WO2010047078A1 (ja) | 2010-04-29 |
Family
ID=42119133
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2009/005448 WO2010047078A1 (ja) | 2008-10-20 | 2009-10-19 | 6方向指向装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8528220B2 (ja) |
EP (1) | EP2341314B1 (ja) |
JP (1) | JP5377507B2 (ja) |
WO (1) | WO2010047078A1 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012066852A1 (ja) * | 2010-11-19 | 2012-05-24 | 住友精密工業株式会社 | 6方向指向装置 |
CN104792324A (zh) * | 2015-04-29 | 2015-07-22 | 浙江大学 | 基于超声波电机的高精度小型化光纤陀螺寻北仪转位机构 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10982530B2 (en) | 2016-04-03 | 2021-04-20 | Schlumberger Technology Corporation | Apparatus, system and method of a magnetically shielded wellbore gyroscope |
WO2021003530A1 (en) * | 2019-07-10 | 2021-01-14 | Paul Chapman | Improved magnetic compass card |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63205512A (ja) * | 1987-02-20 | 1988-08-25 | Sumitomo Electric Ind Ltd | 方位検出方法 |
JPH063149A (ja) | 1992-06-24 | 1994-01-11 | Japan Aviation Electron Ind Ltd | 方位計 |
JPH0611350A (ja) | 1992-06-26 | 1994-01-21 | Japan Aviation Electron Ind Ltd | 方位計 |
JPH09138128A (ja) * | 1995-11-15 | 1997-05-27 | Tokimec Inc | ジャイロコンパス |
JPH11160072A (ja) | 1997-11-25 | 1999-06-18 | Data Tec:Kk | 真方位計測装置 |
JPH11190633A (ja) | 1997-12-26 | 1999-07-13 | Japan Aviation Electron Ind Ltd | 方位計 |
JP2000121364A (ja) * | 1998-10-15 | 2000-04-28 | Japan Aviation Electronics Industry Ltd | 方位計 |
JP2001215121A (ja) | 2000-02-03 | 2001-08-10 | Tamagawa Seiki Co Ltd | 方位検出方法及び装置 |
JP2002296037A (ja) | 2001-03-30 | 2002-10-09 | Tokimec Inc | ジャイロコンパス装置 |
US6594911B2 (en) | 2001-05-03 | 2003-07-22 | Sagem Sa | Long-term navigation method and device |
US6918186B2 (en) | 2003-08-01 | 2005-07-19 | The Charles Stark Draper Laboratory, Inc. | Compact navigation system and method |
JP2008215956A (ja) | 2007-03-01 | 2008-09-18 | Sumitomo Precision Prod Co Ltd | 方位計測装置及びその方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0658321A (ja) * | 1992-08-10 | 1994-03-01 | Kayaba Ind Co Ltd | ボールジョイント |
US6071031A (en) * | 1994-12-05 | 2000-06-06 | Hexel Corporation | Movable mechanical structures |
EP1870790A1 (fr) * | 2006-06-23 | 2007-12-26 | The Swatch Group Research and Development Ltd. | Dispositif de positionnement d'un objet dans toutes les directions |
JP2011213138A (ja) * | 2010-03-31 | 2011-10-27 | Sumitomo Precision Prod Co Ltd | 擬似無重力生成装置 |
JP5749919B2 (ja) * | 2010-11-19 | 2015-07-15 | 住友精密工業株式会社 | 6方向指向装置 |
-
2009
- 2009-10-19 WO PCT/JP2009/005448 patent/WO2010047078A1/ja active Application Filing
- 2009-10-19 JP JP2010534681A patent/JP5377507B2/ja active Active
- 2009-10-19 US US13/125,281 patent/US8528220B2/en active Active
- 2009-10-19 EP EP09821778.9A patent/EP2341314B1/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63205512A (ja) * | 1987-02-20 | 1988-08-25 | Sumitomo Electric Ind Ltd | 方位検出方法 |
JPH063149A (ja) | 1992-06-24 | 1994-01-11 | Japan Aviation Electron Ind Ltd | 方位計 |
JPH0611350A (ja) | 1992-06-26 | 1994-01-21 | Japan Aviation Electron Ind Ltd | 方位計 |
JPH09138128A (ja) * | 1995-11-15 | 1997-05-27 | Tokimec Inc | ジャイロコンパス |
JPH11160072A (ja) | 1997-11-25 | 1999-06-18 | Data Tec:Kk | 真方位計測装置 |
JPH11190633A (ja) | 1997-12-26 | 1999-07-13 | Japan Aviation Electron Ind Ltd | 方位計 |
JP2000121364A (ja) * | 1998-10-15 | 2000-04-28 | Japan Aviation Electronics Industry Ltd | 方位計 |
JP2001215121A (ja) | 2000-02-03 | 2001-08-10 | Tamagawa Seiki Co Ltd | 方位検出方法及び装置 |
JP2002296037A (ja) | 2001-03-30 | 2002-10-09 | Tokimec Inc | ジャイロコンパス装置 |
US6594911B2 (en) | 2001-05-03 | 2003-07-22 | Sagem Sa | Long-term navigation method and device |
US6918186B2 (en) | 2003-08-01 | 2005-07-19 | The Charles Stark Draper Laboratory, Inc. | Compact navigation system and method |
JP2008215956A (ja) | 2007-03-01 | 2008-09-18 | Sumitomo Precision Prod Co Ltd | 方位計測装置及びその方法 |
Non-Patent Citations (1)
Title |
---|
See also references of EP2341314A4 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012066852A1 (ja) * | 2010-11-19 | 2012-05-24 | 住友精密工業株式会社 | 6方向指向装置 |
JP2012112679A (ja) * | 2010-11-19 | 2012-06-14 | Sumitomo Precision Prod Co Ltd | 6方向指向装置 |
EP2604973A1 (en) * | 2010-11-19 | 2013-06-19 | Sumitomo Precision Products Co., Ltd. | Six-direction directing device |
CN103221776A (zh) * | 2010-11-19 | 2013-07-24 | 住友精密工业株式会社 | 6方向指向装置 |
EP2604973A4 (en) * | 2010-11-19 | 2015-02-18 | Sumitomo Precision Prod Co | ORIENTATION DEVICE IN SIX DIRECTIONS |
US9015952B2 (en) | 2010-11-19 | 2015-04-28 | Sumitomo Precision Products Co., Ltd. | Six-direction directing device |
CN104792324A (zh) * | 2015-04-29 | 2015-07-22 | 浙江大学 | 基于超声波电机的高精度小型化光纤陀螺寻北仪转位机构 |
Also Published As
Publication number | Publication date |
---|---|
US20110197460A1 (en) | 2011-08-18 |
EP2341314A4 (en) | 2016-05-11 |
EP2341314A1 (en) | 2011-07-06 |
US8528220B2 (en) | 2013-09-10 |
EP2341314B1 (en) | 2017-03-08 |
JPWO2010047078A1 (ja) | 2012-03-22 |
JP5377507B2 (ja) | 2013-12-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5749919B2 (ja) | 6方向指向装置 | |
TWI613418B (zh) | 具支點元件的微機電裝置 | |
US11346495B2 (en) | Control method for non-orthogonal gimbal, gimbal thereof, and storage device | |
JP5377507B2 (ja) | 6方向指向装置 | |
JP2007155584A (ja) | 慣性航法システム | |
JPWO2007099599A1 (ja) | 磁気式ジャイロ | |
JP3852592B2 (ja) | ジャイロ装置及び掘削用ジャイロ装置の使用方法 | |
EP3748294B1 (en) | Direction finder | |
JP4938496B2 (ja) | 方位計測装置及びその方法 | |
JP6550906B2 (ja) | 傾斜度測定方法及び装置並びに電子機器及びプログラム | |
JPH098533A (ja) | アンテナ姿勢制御装置 | |
JP2006047295A (ja) | 方位計測装置 | |
CN216977925U (zh) | 光纤陀螺仪分辨率的测量系统、可读存储介质 | |
JP6477214B2 (ja) | 傾斜度測定方法及び装置並びに電子機器及びプログラム | |
AU2019201449B2 (en) | Borehole survey instrument and method | |
WO2022249292A1 (ja) | 姿勢センサーのキャリブレーション装置 | |
RU2210740C1 (ru) | Способ гирокомпасирования с применением гироскопического датчика угловой скорости, установленного на управляемую в азимуте и стабилизированную в плоскости местного горизонта платформу | |
JP6250031B2 (ja) | 方位検出装置 | |
RU96111913A (ru) | Гироскопический инклинометр и способ определения угловой ориентации скважин | |
CN114322970A (zh) | 一种双陀螺仪寻北方法、系统及存储介质 | |
CN114518127A (zh) | 光纤陀螺仪分辨率的测量方法、系统、可读存储介质 | |
JPH11190633A (ja) | 方位計 | |
JPH01127907A (ja) | 光学式方位測定装置による方位測定方法及びその方位測定方法に用いる装置 | |
JP2005001580A (ja) | 指向制御装置 | |
JPH10300733A (ja) | 超音波探傷装置の位置方位検出用同心2軸球型センサーヘッド |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 09821778 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2010534681 Country of ref document: JP |
|
REEP | Request for entry into the european phase |
Ref document number: 2009821778 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2009821778 Country of ref document: EP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 13125281 Country of ref document: US |