Work machine rotation angle detection device

The rotation angle detection device for work machines uses sensors and a reflector with a changing surface to accurately detect the rotation angle of moving parts, overcoming interference issues and improving precision in remote and automatic operations.

JP2024164677APending Publication Date: 2024-11-27角 和樹
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
JP2023080338
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-15
Publication Date
2024-11-27

AI Technical Summary

Technical Problem

Existing work machines face challenges in accurately detecting the rotation angle of moving parts relative to the main body due to space constraints and interference from dirt and mud, which affect detection accuracy.

Method used

A rotation angle detection device comprising a distance measurement sensor on both the upper and lower rotary bodies, a reflector with a changing side surface, and a control unit to calculate the rotation angle based on measured distances and stored data, minimizing interference from dirt and mud.

Benefits of technology

The device accurately detects the rotation angle of moving parts relative to the main body, reducing errors from dirt and mud, and can be easily retrofitted to existing machines, enhancing precision in remote and automatic operations.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024164677000001_ABST
    Figure 2024164677000001_ABST
Patent Text Reader

Abstract

To provide a rotation angle detection device for a work machine and the like that are hard to be impacted by sediment and the like, and can more accurately detect a rotation angle of a movement unit relative to a main body unit.SOLUTION: A rotation angle detection device 30 comprises: a distance measurement sensor 32 that is rotatable around a reference axis together with an upper rotary body, and measures a distance to a measurement object; a reflector 31 that is rotatable around the reference axis together with a lower rotary body, provided with a space apart from the distance measurement sensor 32, and has a lateral face part 131 serving as the measurement object in which a distance between the distance measurement sensor 32 and the reflector continuously or discontinuously varies during one rotation around the reference axis; a storage unit 34 that stores data associating a distance from the distance measurement sensor 32 to the lateral face part 131 during one rotation of the reflector 31 around the reference axis with a rotation angle of the lower rotary body around the reference axis relative to the upper rotary body; and a control unit 35 that acquires a rotation angle of the lower rotary body on the basis of the distance measured by the distance measurement 32, and the data stored in the storage unit 34.SELECTED DRAWING: Figure 3
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present disclosure relates to a rotation angle detection device for a work machine. [Background technology]

[0002] In recent years, technologies have been developed for remotely controlling or automatically driving work machines such as backhoes, power shovels, etc. For example, a system has been proposed that detects the position and attitude of a work machine based on GPS position information (see, for example, Patent Documents 1 and 2). [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Application Publication No. 4-296683 [Patent Document 2] Japanese Patent Application Publication No. 10-88624 Summary of the Invention [Problem to be solved by the invention]

[0004] In a work machine such as a backhoe or a power shovel, the main body and the moving part are connected to be able to rotate infinitely. In this type of work machine, there is almost no space to install a GPS receiver in the moving part, and it is also difficult to wire a power cable because of the infinite rotation. For this reason, the GPS receiver is installed in the main body. The position and front direction of the main body of the work machine can be detected from the GPS position information received by the main body. However, since the moving part also rotates in a direction different from that of the main body, it is not possible to know the rotation angle (turning position) of the moving part relative to the main body from the GPS position information received by the main body. When a work machine is operated remotely or automatically, it is difficult to guide the work machine to a target position if the rotation angle of the moving part relative to the main body is not known.

[0005] By providing a rotation angle sensor such as a rotary sensor or an optical encoder on the main body and moving part of a work machine, it is possible to detect the rotation angle of the moving part relative to the main body. However, it is difficult to retrofit a rotation angle sensor to most existing work machines. When retrofitting an existing work machine with the same function as a rotation angle sensor, for example, a configuration in which a belt is attached to the outer periphery of the lower rotating body of the moving part and the rotation of the belt is detected by an encoder is conceivable. However, there is a concern that soil or mud (hereinafter also referred to as "soil, etc.") may get stuck between the belt and the encoder while the work machine is working, or that the position of the belt or encoder may be shifted due to the soil, etc., resulting in a decrease in the accuracy of detecting the rotation angle.

[0006] An object of the present disclosure is to provide a rotation angle detection device for a work machine that is less susceptible to the effects of soil and sand, etc., and that can more accurately detect the rotation angle of a moving part relative to a main body part. [Means for solving the problem]

[0007] The rotation angle detection device for a work machine according to the present disclosure is a work machine rotation angle detection device that includes a main body having an upper rotating body rotatable around a reference axis, and a moving unit having a lower rotating body rotatably connected to the upper rotating body around the reference axis, and the main body and the moving unit are infinitely rotatable, and includes a distance measuring sensor that is provided on the main body, rotatable around the reference axis together with the upper rotating body, and measures the distance to an object to be measured, and a distance measuring sensor that is rotatable around the reference axis together with the lower rotating body, provided opposite to the distance measuring sensor, and measures the distance to an object to be measured. the distance measuring sensor measures the distance from the distance measuring sensor to the side surface as a measurement object, the distance between the distance measuring sensor and the side surface changing continuously or discontinuously during one rotation of the reflector around a reference axis; a memory unit that stores data correlating the distance from the distance measuring sensor to the side surface during one rotation of the reflector around a reference axis with the rotation angle of the lower rotating body around the reference axis relative to the upper rotating body; and a control unit that acquires the rotation angle of the lower rotating body around the reference axis relative to the upper rotating body, which is associated with the distance, based on the distance to the side surface measured by the distance measuring sensor and the data stored in the memory unit. Effect of the Invention

[0008] The work machine rotation angle detection device according to the present disclosure is less susceptible to the effects of soil and sand, etc., and can more accurately detect the rotation angle of the moving part relative to the main body. [Brief description of the drawings]

[0009] [Figure 1] 1 is a side view of a working machine 1 equipped with a rotation angle detection device 30. FIG. [Diagram 2] 1 is a conceptual diagram of a working machine 1 in a plan view. [Diagram 3] 2 is a block diagram showing a configuration of a rotation angle detection device 30. FIG. [Figure 4] 3A to 3C are diagrams illustrating an example of the configuration of a reflector 31. [Diagram 5] 13 is a diagram showing an example of data that associates distance Ds with rotation angle θ stored in storage unit 34. FIG. [Figure 6] 13(A) to 13(D) are conceptual diagrams illustrating the rotation angle θ of the moving part 20. FIG. [Figure 7] 1A to 1D are conceptual diagrams illustrating the change in the distance between distance measuring sensor 32 and reflector 31. FIG. [Figure 8] 4 is a flowchart showing the procedure of a rotation angle detection process executed by the rotation angle detection device 30. [Figure 9] 1 is a conceptual diagram showing a case where the clothoid curve shape of a side surface portion 131 of a reflector 31 is formed by a polygon. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0010] Hereinafter, an embodiment of a rotation angle detection device for a work machine according to one aspect of the present disclosure will be described. The drawings attached to this specification are all schematic or conceptual diagrams, and the shape, scale, aspect ratio, and the like of each part have been modified or exaggerated from the actual product in consideration of ease of understanding, etc. In addition, hatching showing cross sections of members has been omitted as appropriate in the drawings.

[0011] In this specification etc., the front-to-rear direction of the work machine 1 shown in Figures 1 and 2 will be described as the X (X1-X2) direction, the left-to-right direction as the Y (Y1-Y2) direction, and the vertical height direction as the Z (Z1-Z2) direction. Note that the work machine 1 can travel in various directions, but in the embodiment, the front direction of the cabin 11 shown in Figure 1 (the front direction as seen by the operator) will be described as the forward direction X1. In figures that do not show the cabin 11, the front direction of the cabin 11 is indicated by an arrow mark. Furthermore, in this specification, "direction" will also be referred to as "side" as appropriate.

[0012] Fig. 1 is a side view of a work machine 1 equipped with a rotation angle detection device 30. Fig. 2 is a conceptual diagram of the work machine 1 in a plan view. In Fig. 2, the main body unit 10 and the moving unit 20 are appropriately simplified or omitted. Fig. 3 is a block diagram showing the configuration of the rotation angle detection device 30. Fig. 4 is a diagram showing an example of data correlating distance Ds with rotation angle θ stored in memory unit 34.

[0013] The work machine 1 shown in Fig. 1 is, for example, a heavy machine used at a construction site, such as a backhoe or a power shovel. As will be described later, the work machine 1 is an existing work machine on which it is not assumed that a rotation angle detection device 30 will be provided. The work machine 1 can be manually operated by an operator on board, but in this embodiment, a case will be described in which the work machine 1 is remotely operated or automatically operated without an operator on board. The work machine 1 comprises a main body unit 10, a moving unit 20, and a rotation angle detection device 30 (see Fig. 3).

[0014] The main body 10 is a housing having a device for operating the working arm 12 (described later), and is disposed on the upper side Z1 of the moving part 20. The main body 10 includes a cabin 11, the working arm 12, a mechanism part 13, a main body base 14, an upper rotating body 15, etc. The cabin 11 is a housing in which an operator sits during manual driving. The cabin 11 is provided with a travel lever for independently controlling the rotation of the left and right driving wheels (described later), as well as a remote control device (neither of which are shown) for remotely operating the travel lever. The cabin 11 is also provided with a control box 130 which integrates a memory part 34, a control part 35, and a communication part 36 (described later) of the rotation angle detection device 30.

[0015] The working arm 12 is a structure whose base end side is supported by the main body 10. The working arm 12 has an arm body, a hydraulic cylinder, a hydraulic hose, a bucket, etc. (reference numbers omitted). The mechanism 13 has a hydraulic device that supplies hydraulic power to the moving part 20 and the working arm 12, as well as a counterweight for balancing the working arm 12 (none of which are shown). The cabin 11, the working arm 12, and the mechanism 13 are provided on the main body base 14. The main body base 14 is a structure that supports the cabin 11 and the like. The main body 10 has an upper rotating body 15 on the lower side Z2 of the main body base 14. The upper rotating body 15 is a member that rotates together with the main body 10, and is configured to be rotatable around a reference axis OA (described later). As shown in FIG. 1 and FIG. 2, the main body 10 has a distance measuring sensor 32 at a position separated from the upper rotating body 15 on the lower side Z2 of the main body base 14. 1 and 2, the main body 10 includes a pair of GPS receivers 33. The distance measuring sensor 32 and the GPS receiver 33 will be described later.

[0016] The moving unit 20 is a structure including a mechanism for moving the main body 10. The moving unit 20 is provided on the lower side Z2 of the main body 10. As shown in FIG. 1, the moving unit 20 includes a crawler 21, a traveling base 22, a lower rotating body 25, and the like. The crawler 21 is a traveling device that is controlled independently on the left and right sides. As shown in FIG. 2, the crawler 21 is provided on both sides of the left and right direction Y of the work machine 1. As shown in FIG. 1, the crawler 21 includes a driving wheel 23 and a running belt 24. The driving wheel 23 is a wheel that is driven by hydraulic power supplied from the mechanism unit 13. The pair of driving wheels 23 is provided on both ends in the front-rear direction X. The running belt 24 is an endless belt member that is driven by the driving wheel 23. The running belt 24 is stretched between the pair of driving wheels 23. The pair of left and right crawlers 21 are supported by the running base 22.

[0017] The traveling base 22 is a structure that supports the crawler 21 and the lower rotating body 25 (described later). The lower rotating body 25 is a member that is connected to the upper rotating body 15 so as to be rotatable around a reference axis OA. The lower rotating body 25 and the above-mentioned upper rotating body 15 are made of a steel material (e.g., cast iron, carbon steel, etc.). The reference axis OA is an axis that is a common rotation center of the upper rotating body 15 and the lower rotating body 25. "Rotatable around the reference axis OA" means that it is rotatable clockwise and counterclockwise around the reference axis OA. The main body 10 and the moving part 20 are configured to be infinitely rotatable independently of each other at the upper rotating body 15 and the lower rotating body 25. In FIG. 2, "CL1" is a center line that passes through the reference axis OA of the main body 10. Similarly, "CL2" is a center line that passes through the reference axis OA of the moving part 20. In the work machine 1 shown in FIG. 2, the center line CL1 of the main body 10 and the center line CL2 of the moving part 20 are in an overlapping state.

[0018] As shown in Figs. 1 and 2, a reflector 31 is attached to the outer periphery of the lower rotating body 25. The reflector 31 is a member that can rotate around the reference axis OA together with the lower rotating body 25. The reflector 31 is provided at a distance from the distance measuring sensor 32 so as to face the distance measuring sensor 32. The reflector 31 can be attached to the outer periphery of the lower rotating body 25 as an add-on. In other words, the reflector 31 can be attached to an existing work machine 1 that is not designed to be equipped with a rotation angle detection device 30. The reflector 31 (side surface portion 131) will be described later.

[0019] As shown in Fig. 3, the rotation angle detection device 30 includes a reflector 31, a distance measuring sensor 32, a GPS receiver 33, a storage unit 34, a control unit 35, and a communication unit 36. As described above, the reflector 31 is provided on the lower rotating body 25 of the moving unit 20 (see Fig. 2). The distance measuring sensor 32 and the GPS receiver 33 are provided on the main body unit 10 (see Fig. 1). Moreover, the storage unit 34, the control unit 35, and the communication unit 36 ​​are integrated into a control box 130 and provided in the cabin 11 of the main body unit 10, as shown in Fig. 1.

[0020] 2, the reflector 31 has a side surface portion 131. The distance between the side surface portion 131 and the distance measuring sensor 32 changes continuously while the reflector 31 rotates once around the reference axis OA. In the reflector 31 of this embodiment, the side surface portion 131 has a clothoid curve shape whose curvature changes at a constant rate during one rotation around the reference axis OA. In other words, the distance between the side surface portion 131 and the distance measuring sensor 32 changes continuously while the reflector 31 rotates once around the reference axis OA, and the distance between the side surface portion 131 and the distance measuring sensor 32 is never the same at different positions.

[0021] The light reflectance of the side surface 131 of the reflector 31 may or may not be high depending on the measurement method of the distance measuring sensor 32 (described later). When the light reflectance of the side surface 131 of the reflector 31 is to be high, for example, the light reflectance can be increased by attaching a reflective tape to the side surface 131. Examples of the reflective tape or the base material of the reflective tape that can be applied to the reflector 31 include a retroreflective sheet, a metallized polyester film, an optical film, an aluminum foil, a polyvinyl chloride (PVC) sheet, and the like. In addition, when the light reflectance of the side surface 131 of the reflector 31 is not to be high, a paint such as black may be applied to the outer surface of the reflector 31, or the base color of the member (for example, a metal plate described later) that constitutes the side surface 131 may be left as it is.

[0022] Here, the configuration of the reflector 31 in this embodiment will be described. FIG. 4 is a diagram showing the configuration of the reflector 31. The reflector 31 shown in FIG. 4 includes a magnet belt 331, a support material 332, and a reflecting portion 333. The magnet belt 331 is a band-shaped member made of rubber, resin, or the like mixed with a powdered magnetic material (such as ferrite). The magnet belt 331 has a magnetic force, and can be attached to the lower rotating body 25 as is. The magnetic force of the magnet belt 331 is set to a degree that the magnet belt 331 does not come off the lower rotating body 25 or does not shift in position during operation of the work machine 1. Note that instead of the magnet belt 331, a rubber or resin belt not containing a magnetic material may be used. In that case, the belt can be attached to the lower rotating body 25 with an adhesive or the like.

[0023] The support material 332 is a member that supports the reflecting portion 333. The support materials 332 are arranged on the magnet belt 331 at intervals. The support materials 332 have different heights depending on the positions on the magnet belt 331 where they are arranged. The support materials 332 are formed so that their heights gradually decrease clockwise from the starting point 131a shown in FIG. 4. The height of each support material 332 is set so that, when the reflector 31 is attached to the lower rotating body 25, a virtual line connecting the tops forms a clothoid curve shape. For example, rubber, resin, etc. can be used as the support material 332. Each support material 332 can be attached to the magnet belt 331 by, for example, an adhesive. The reflecting portion 333 is a long and thin band-shaped member that constitutes the side portion 131 of the reflector 31. For example, a metal plate, a resin plate, etc. can be used as the reflecting portion 333. For example, the reflecting portion 333 can be attached to the support material 332 by, for example, an adhesive. As described above, when the light reflectance of the side surface portion 131 is to be increased, the above-mentioned reflective tape or the like may be attached to the outer peripheral surface of the reflecting portion 333. When the light reflectance of the side surface portion 131 is not to be increased, the outer surface of the reflector 31 may be painted with a black paint or the like, or the color of the material constituting the side surface portion 131 may be left as it is.

[0024] The reflector 31 configured as described above can be attached to the lower rotating body 25 without using adhesives or the like because the attachment portion (magnetic belt 331) to the lower rotating body 25 has a magnetic force. If the position of the reflector 31 attached to the lower rotating body 25 is not appropriate, the reflector 31 (magnetic belt 331) can be easily peeled off from the lower rotating body 25. Therefore, the position of the reflector 31 can be easily corrected and the work of attaching it to the lower rotating body 25 again can be easily performed. In addition, when the reflector 31 is attached to the lower rotating body 25, the reflector 31 and the distance measuring sensor 32 are separated from each other and do not come into contact with each other during the operation of the work machine 1. Therefore, by appropriately setting the magnetic force of the magnetic belt 331, it is possible to prevent the reflector 31 from coming off the lower rotating body 25 or from shifting its position during the operation of the work machine 1.

[0025] Returning to Fig. 3, the distance measuring sensor 32 is an optical measuring device that measures the distance to the side surface portion (measurement object) 131 of the reflector 31. The distance measuring sensor in this embodiment is a laser distance sensor. The distance to the side surface portion 131 measured by the distance measuring sensor (hereinafter also referred to as "distance Ds") is transmitted to the control unit 35.

[0026] The GPS receiver 33 is a device (position information acquisition device) that receives radio waves (satellite signals) transmitted from GPS satellites and acquires position information by a calculation method such as three-dimensional phase. The position information acquired by each of the pair of GPS receivers 33 is transmitted to the control unit 35. As shown in FIG. 2, the pair of GPS receivers 33 are disposed at predetermined positions at equal intervals with the center line CL1 of the main body unit 10 therebetween. Since the positional relationship between the main body unit 10 (cabin 11) and the pair of GPS receivers 33 is fixed, the control unit 35 (described later) can calculate the front direction of the main body unit 10 based on the center line CL1 based on the position information acquired at each of the two GPS receivers 33.

[0027] The position information acquisition device for acquiring the position information is not limited to the above-mentioned GPS receiver. For example, a fixed LiDAR (optical radar), a radio beacon, a surveying instrument (total station), etc. can be used as the position information acquisition device. In particular, when the work machine 1 is used indoors (inside a building such as a factory or warehouse), it is difficult for GPS radio waves to reach the work machine 1, making it difficult to acquire the position information. Therefore, by using a fixed LiDAR or the like that does not depend on GPS radio waves as the position information acquisition device, the position information of the main body 10 can be acquired more appropriately.

[0028] The storage unit 34 is a storage device that stores data that associates a distance D from the distance measuring sensor 32 to the side surface portion 131 while the reflector 31 rotates once around the reference axis OA with a rotation angle θ of the lower rotating body 25 (moving portion 20) around the reference axis OA relative to the upper rotating body 15 (main body portion 10), as shown in Fig. 4. Note that the values ​​of the distance D and the rotation angle θ shown in Fig. 4 are merely examples, and are not limited to the values ​​shown in Fig. 4. For example, the range of the distance D may be about 100 to 200 mm, depending on the accuracy of the distance measuring sensor 32.

[0029] Returning to FIG. 3, the communication unit 36 ​​is a communication interface that transmits and receives data via wireless communication with a remote control or automatic driving system device (not shown). The control unit 35 is a control unit that controls the operation of the rotation angle detection device 30 (described later) based on the distance Ds obtained from the distance measuring sensor 32, the data stored in the storage unit 34, the position information obtained from the GPS receiver 33, etc., and is configured with a microprocessor including a CPU (Central Processing Unit), memory, etc. The functions of the control unit 35 may be realized by a combination of hardware and software, or may be realized by hardware alone.

[0030] The control unit 35 acquires a rotation angle θ of the moving unit 20 around the reference axis OA relative to the main body unit 10 (hereinafter, also referred to as "rotation angle θ of the moving unit 20") based on the distance Ds acquired from the distance measuring sensor 32 and the data stored in the memory unit 34 (see FIG. 4). Specifically, the control unit 35 searches the data stored in the memory unit 34 for the distance D corresponding to the distance Ds, and acquires the rotation angle θ associated with the distance D. If the distance Ds acquired from the distance measuring sensor 32 includes a value less than 1.0 mm, an approximation of the distance Ds may be obtained by rounding. For example, if the measured distance Ds is 51.3 mm, the distance Ds may be 51.0 mm obtained by rounding off the decimal point.

[0031] The control unit 35 calculates the position and front direction of the work machine 1 based on the position information received by the GPS receiver. The control unit 35 also calculates the orientation of the moving unit 20 (the orientation of the center line CL2) based on the calculated front direction of the work machine 1 (main body unit 10) and the rotation angle θ of the moving unit 20 relative to the main body unit 10. The control unit 35 transmits the rotation angle θ of the moving unit 20 relative to the main body unit 10, information on the position and front direction of the work machine 1, and information on the orientation of the moving unit 20 to a remote control or automatic driving system device (not shown) via the communication unit 36. In the remote control system device, the position, attitude (orientation of the main body unit 10 and the moving unit 20), etc. of the work machine 1 are graphically displayed on a monitor based on the above information, so that the remote control operator can grasp the traveling direction of the work machine 1 and the rotation angle of the main body unit 10 and the moving unit 20, etc. in real time. Furthermore, in an automatic driving system device, by controlling the direction of travel of the work machine 1 and the rotation angles of the main body 10 and the moving part 20, etc. based on the above information, the work machine 1 can be more accurately guided to the target position.

[0032] Next, a change in the distance between the distance measuring sensor 32 and the reflector 31 (side surface portion 131) when the moving unit 20 rotates around the reference axis OA with respect to the main body unit 10 will be described. Figs. 6(A) to 6(D) are conceptual diagrams for explaining the rotation angle θ of the moving unit 20. Figs. 6(A) to 6(D) show the state where the moving unit 20 rotates counterclockwise with respect to the main body unit 10 at intervals of 90°. Figs. 7(A) to 7(D) are conceptual diagrams for explaining the change in the distance between the distance measuring sensor 32 and the reflector 31. Figs. 7(A) to 7(D) are diagrams corresponding to Figs. 6(A) to 7(D) and show the state where the moving unit 20 rotates counterclockwise with respect to the main body unit 10. That is, Figs. 7(A) to 7(D) show the change in the distance between the distance measuring sensor 32 and the reflector 31 at intervals of 90° when the reflector 31 (lower rotating body 25) rotates counterclockwise with respect to the upper rotating body 15. In the following description, the position where the starting point 131a of the side surface portion 131 of the reflector 31 faces the measurement surface (center) 32a of the distance measuring sensor 32 as shown in FIG. 7(A) is taken as the reference position.

[0033] As shown in Fig. 6(A), in the work machine 1, when the center line CL1 of the main body 10 and the center line CL2 of the moving part 20 overlap, that is, when the moving part 20 is not rotating with respect to the main body 10, the starting point 131a of the reflector 31 is in a position (reference position) facing the measurement surface 32a of the distance measuring sensor 32, as shown in Fig. 7(A). At the reference position, the distance Ds (Ds0) between the reflector 31 and the distance measuring sensor 32 is minimum. The control unit 35 acquires the rotation angle θ (0°) of the reflector 31 based on the distance Ds0 (50 mm in this example) acquired by the distance measuring sensor 32 and the data stored in the memory unit 34 (see Fig. 4).

[0034] As shown in Fig. 6(B), in the work machine 1, when the moving part 20 rotates 90° counterclockwise relative to the main body part 10, the distance Ds (Ds1) between the reflector 31 and the distance measuring sensor 32 becomes longer than the distance Ds0 when the rotation angle is 0°, as shown in Fig. 7(B). The control part 35 acquires the rotation angle θ (90°) of the reflector 31 based on the distance Ds1 (62.5 mm in this example) acquired by the distance measuring sensor 32 and the data stored in the memory part 34.

[0035] As shown in Fig. 6(C), in the work machine 1, when the moving part 20 rotates 180° counterclockwise relative to the main body part 10, the distance Ds (Ds2) between the reflector 31 and the distance measuring sensor 32 becomes longer than the distance Ds1 at a rotation angle of 90° as shown in Fig. 7(C). The control part 35 acquires the rotation angle θ (180°) of the reflector 31 based on the distance Ds2 (75.0 mm in this example) acquired by the distance measuring sensor 32 and the data stored in the memory part 34.

[0036] As shown in Fig. 6(D), in the work machine 1, when the moving part 20 rotates 270° counterclockwise relative to the main body part 10, the distance Ds (Ds3) between the reflector 31 and the distance measuring sensor 32 becomes longer than the distance Ds2 at a rotation angle of 180° as shown in Fig. 7(D). The control part 35 acquires the rotation angle θ (270°) of the reflector 31 based on the distance Ds3 (87.5 mm in this example) acquired by the distance measuring sensor 32 and the data stored in the memory part 34.

[0037] 6(D), that is, when the moving part 20 rotates 360° counterclockwise with respect to the main body part 10, the starting point 131a of the reflector 31 returns to the reference position facing the measurement surface 32a of the distance measuring sensor 32, as shown in FIG. 7(A). As a result, the distance Ds (Ds0) between the distance measuring sensor 32 and the reflector 31 becomes minimum again, so that the control part 35 obtains the rotation angle θ (0°) of the reflector 31 based on the distance Ds0 (50 mm in this example) obtained by the distance measuring sensor 32 and the data stored in the storage part 34.

[0038] 6(A) to (D) and 7(A) to (D) show an example in which the moving part 20 rotates counterclockwise relative to the main body part 10, but the same applies when the moving part 20 rotates clockwise relative to the main body part 10, and the rotation angle θ of the moving part 20 can be detected according to the distance Ds between the distance measuring sensor 32. Also, although the rotation angles of the moving part 20 relative to the main body part 10 are 0° (360°), 90°, 180°, and 270° as examples, the present invention is not limited to these and may be any rotation angle.

[0039] Next, the rotation angle detection process executed by the above-mentioned rotation angle detection device 30 will be described with reference to Fig. 8. Fig. 8 is a flowchart showing the steps of the rotation angle detection process executed by the rotation angle detection device 30. The rotation angle detection process shown in Fig. 8 is repeatedly executed at intervals of, for example, about several tens of ms to 100 ms while the work machine 1 is in operation.

[0040] In step S101 shown in FIG. 8, the control unit 35 acquires the distance Ds from the distance measuring sensor 32. In step S102, the control unit 35 searches for a distance D corresponding to the measured distance Ds from the data (see FIG. 4) stored in the storage unit 34. As described above, if the distance Ds includes a value less than 1.0 mm, an approximation of the distance Ds may be obtained by rounding.

[0041] In step S103, the control unit 35 acquires the rotation angle θ of the moving unit 20 about the reference axis OA relative to the main body unit 10, based on the searched distance D and the data stored in the storage unit . In step S104, the control unit 35 transmits data including the acquired rotation angle θ to a remote control or automatic driving system device via the communication unit 36. When the data transmission is completed in step S104, the process of this flowchart ends (return to step S101). Note that the process of the flowchart shown in FIG. 8 is an example, and other processes may be included.

[0042] According to the rotation angle detection device 30 of the present embodiment described above, for example, the following effects are obtained. The rotation angle detection device 30 includes a distance measuring sensor 32 that can rotate together with the upper rotating body 15, and a reflector 31 that is provided at a distance from the distance measuring sensor 32, can rotate together with the lower rotating body 25, and has a side portion 131 whose distance from the distance measuring sensor 32 changes during one rotation. According to this configuration, since the distance measuring sensor 32 and the reflector 31 are spaced apart, soil and sand are unlikely to get stuck between them, and positional deviation due to adhesion of soil and sand is unlikely to occur. Therefore, the rotation angle detection device 30 of this embodiment is less susceptible to the effects of soil and sand compared to a configuration in which an encoder detects the rotation of a belt attached to the outer periphery of the lower rotating body, and deterioration of detection accuracy can be suppressed.

[0043] The rotation angle detection device 30 also includes a storage unit 34 that stores data associating the distance between the distance measuring sensor 32 and the rotation angle of the moving unit 20, and a control unit 35 that acquires the rotation angle of the moving unit 20 associated with the distance based on the distance measured by the distance measuring sensor 32 and the data stored in the storage unit 34. According to this configuration, the rotation angle of the moving unit 20 is acquired using data associating the distance to the reflector 31 measured by the distance measuring sensor 32 with the rotation angle of the moving unit 20, so that the occurrence of errors due to adhesion of soil and sand or vibration can be suppressed compared to a method of calculating the rotation angle of the moving unit by converting a position change due to rotation into an electrical signal, such as an encoder. Therefore, according to the rotation angle detection device 30 of this embodiment, it is less susceptible to the influence of soil and sand, and the rotation angle of the moving unit 20 relative to the main body unit 10 can be detected more accurately.

[0044] In the rotation angle detection device 30, the side surface 131 of the reflector 31 has a clothoid curve shape whose curvature changes at a constant rate during one rotation around the reference axis OA. According to this configuration, while the moving part 20 rotates 360° around the reference axis OA relative to the main body part 10, the distance between the reflector 31 and the distance measuring sensor 32 changes continuously, and the same distance is never measured during one rotation. Therefore, the rotation angle θ of the moving part 20 relative to the main body part 10 can be detected more accurately.

[0045] In the rotation angle detection device 30, the reflector 31 is provided on the outer periphery of the lower rotating body 25, so that it can be easily retrofitted to an existing work machine and is less likely to become displaced due to vibration. In the rotation angle detection device 30, the distance measuring sensor 32 is a laser distance sensor, so that the distance to the reflector 31 (side surface portion 131) can be measured more accurately. In addition, the distance measuring sensor 32 is provided on the upper rotating body 15 (main body portion 10), so that the supply of power is also easy.

[0046] Since the rotation angle detection device 30 includes a GPS receiver 33, the position and front direction of the work machine 1 can be calculated based on the position information received by the GPS receiver, and information on the position and front direction of the work machine 1 as well as the rotation angle θ of the moving unit 20 relative to the main body 10 can be transmitted to a remote control or automatic driving system device (not shown). As a result, in the remote control system device, the position and attitude (the orientation of the main body 10 and the moving unit 20) of the work machine 1 are graphically displayed on a monitor based on the above information, allowing the remote control operator to grasp the traveling direction of the work machine 1 and the rotation angles of the main body 10 and the moving unit 20 in real time. In addition, in the automatic driving system device, the traveling direction of the work machine 1 and the rotation angles of the main body 10 and the moving unit 20 can be controlled based on the above information, thereby more accurately guiding the work machine 1 to a target position.

[0047] Although the embodiments of the present disclosure have been described above, the present disclosure is not limited to the above-mentioned embodiments, and various modifications and changes are possible, such as the modified forms described below, which are also included in the technical scope of the present disclosure. In addition, the effects described in the embodiments are merely a list of the most preferable effects resulting from the present disclosure, and are not limited to those described in the embodiments. Note that the above-mentioned embodiments and the modified forms described below can be used in appropriate combination, but detailed description will be omitted.

[0048] (Variations) In the embodiment, an example has been described in which the memory unit 34, control unit 35, and communication unit 36 ​​of the rotation angle detection device 30 are integrated into the control box 130 and provided in the cabin 11 of the main body unit 10, but the present invention is not limited to this. At least one or all of the memory unit 34, control unit 35, and communication unit 36 ​​may be provided in a remote control or automatic driving system device. When the memory unit 34, control unit 35, and communication unit 36 ​​are provided in a position separated from the work machine 1, data can be transmitted and received via wireless communication.

[0049] In the embodiment, an example has been described in which a laser distance sensor is used as the distance measuring sensor 32, but any type of sensor may be used as the distance measuring sensor 32 as long as it can measure the distance to the reflector 31 (side surface portion 131). For example, an ultrasonic sensor, an LED sensor, an infrared sensor, a depth sensor (TOF), a magnetic sensor, etc. may be used as the distance measuring sensor 32. The sensor that can be used as the distance measuring sensor 32 may be selected depending on the application of the work machine 1, the usage environment, etc.

[0050] In the embodiment, an example in which the side portion 131 of the reflector 31 is formed in a clothoid curve shape has been described, but the present invention is not limited to this. The side portion 131 may have any shape as long as the distance between the side portion 131 and the distance measuring sensor 32 changes continuously or discontinuously during one rotation around the reference axis OA. FIG. 9 is a conceptual diagram of a case in which the clothoid curve shape of the side portion 131 of the reflector 31 is configured as a polygon. As shown in FIG. 9, by making the clothoid curve shape of the side portion 131 a polygon consisting of a plurality of straight line portions 131b, the shape can be such that the distance between the side portion 131 and the distance measuring sensor 32 changes discontinuously during one rotation around the reference axis OA. Note that such a polygonal configuration is not limited to a clothoid curve, and can also be applied to, for example, a spiral curve or the like.

[0051] In the embodiment, a self-propelled heavy machine such as a backhoe or a power shovel has been described as an example of a work machine, but the present invention is not limited to this. The work machine may have a structure in which the lower part moves while being fixed to a moving body such as a rail or a belt conveyor, and only the upper part rotates. Furthermore, the work machine is not limited to work at a construction site, and may be one that performs "monitoring," "photographing," "transporting goods," and the like at various work sites. [Explanation of symbols]

[0052] 1. Work Machinery 10 Main body 15 Upper Rotating Body 20 Mobile section 25 Lower Rotating Body 30 Rotation angle detection device 31 Reflector 131 Side part 32 Distance measurement sensor 33 GPS receiver 34 Storage section 35 Control section 36 Communications Department 131 Side part

Claims

1. A rotation angle detection device for a working machine comprising a main body having an upper rotating body rotatable around a reference axis, and a moving unit having a lower rotating body rotatably connected to the upper rotating body around the reference axis, wherein the main body and the moving unit are infinitely rotatable, a distance measuring sensor provided in the main body, rotatable together with the upper rotating body about a reference axis, and configured to measure a distance to a measurement object; a reflector that is rotatable around a reference axis together with the lower rotating body, that is spaced apart from the distance measuring sensor so as to face the distance measuring sensor, and that has a side surface as a measurement object in which a distance between the reflector and the distance measuring sensor changes continuously or discontinuously during one rotation around the reference axis; a storage unit configured to store data correlating a distance from the distance measuring sensor to the side surface during one rotation of the reflector around a reference axis with a rotation angle of the lower rotating body around the reference axis relative to the upper rotating body; a control unit that acquires a rotation angle of the lower rotating body about a reference axis with respect to the upper rotating body, the rotation angle being associated with the distance to the side portion measured by the distance measuring sensor and the data stored in the storage unit; A rotation angle detection device for a work machine comprising:

2. The side surface portion has a clothoid curve shape whose curvature changes at a constant rate during one rotation around a reference axis. The rotation angle detection device for a work machine according to claim 1.

3. The reflector is provided on an outer circumferential portion of the lower rotating body.

3. A rotation angle detection device for a work machine according to claim 1 or 2.

4. The distance measurement sensor is a laser distance sensor.

3. A rotation angle detection device for a work machine according to claim 1 or 2.

5. a position information acquisition device for acquiring position information for detecting the position and front direction of the main body unit, 3. A rotation angle detection device for a work machine according to claim 1 or 2.

Citation Information

Patent Citations

  • Self position detecting system

    JP1992296683A

  • GPS unmanned execution control system

    JP1998088624A