Work vehicle, control method, and program
The work vehicle design distributes vehicle gravity across multiple rope segments, reducing tension and torque requirements, enabling efficient and automated operation with lower-torque motors for ridge maintenance tasks.
Patent Information
- Application Number
- JP2022132562
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2022-08-23
- Publication Date
- 2026-02-03
- Estimated Expiration
- 2042-08-23
AI Technical Summary
Existing work vehicles require high-torque motors for winding sections due to increased rope tension, which are either large or expensive, and manual retrieval is necessary when high-torque motors are not used, posing challenges in ridge maintenance tasks.
A work vehicle design with a rope body suspended between fixed pulleys and a movable pulley, distributing the vehicle's gravity across multiple rope segments, reducing tension and allowing lower-torque motors to operate effectively.
The design reduces the torque requirement for the winding motor, enabling efficient and automated operation with lower-torque motors, enhancing mobility and ease of control.
Smart Images

Figure 0007810426000001 
Figure 0007810426000002 
Figure 0007810426000003
Abstract
Description
[Technical Field]
[0001] One aspect of the present invention relates to a work vehicle, a control method, and a program. [Background technology]
[0002] There are many small farm fields in mountainous areas, and the accompanying ridges are large, making it an issue to reduce the labor and effort required for ridge maintenance. Ridge maintenance is an important task for maintaining the ridges and preventing weeds and pests from entering the farmland, but it is anticipated that ridge management will become difficult due to a shortage of workers and an aging workforce, making it difficult to continue farming. Ridge maintenance is work that is not directly linked to production, so there is a need to reduce the labor and make the work more efficient.
[0003] Known examples of work vehicles for performing tasks such as mowing in relation to levee management include those described in Patent Documents 1 and 2. Patent Document 1 discloses a work vehicle that uses tension in a rope body, one end of which is supported by a fixed object, to reel in and let out, thereby propelling the vehicle body. Patent Document 2 discloses a vehicle used for mowing on slopes that determines the relative position of a mower from the direction of travel of the mower and the payout angle and payout amount of two rope bodies. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] Patent No. 7120605 [Patent Document 2] Japanese Patent Application Laid-Open No. 2015-167492 Summary of the Invention [Problem to be solved by the invention]
[0005] In the above-described configuration, due to the structure of lifting a work vehicle with a rope, an increase in vehicle weight increases the tension in the rope, and the torque required by the motor in the winding section that winds up the rope increases. Generally, high-torque motors are difficult to adopt because they are large or expensive. If a high-torque motor is not adopted, the vehicle must be retrieved manually, without winding up the rope. For these reasons, there has been a demand for reducing the torque required by the motor in the winding section.
[0006] One aspect of the present invention has been made in consideration of the above-described situation, and aims to provide a work vehicle, a control method, and a program that can reduce the required torque of the motor in the winding section. [Means for solving the problem]
[0007] A work vehicle according to one embodiment of the present invention comprises a rope body having one end fixed to a fixed object, a winding section provided at the other end of the rope body for winding the rope body, a first fixed pulley provided near the winding section for guiding the rope body being wound by the winding section, a second fixed pulley for guiding the rope body between the fixed object and the first fixed pulley, a vehicle body section that moves on the rope body between the fixed object and the second fixed pulley in the extension direction of the rope body, and a movable pulley fixed to the vehicle body section and suspended on the rope body between the first fixed pulley and the second fixed pulley, and that moves in accordance with the winding of the rope body by the winding section.
[0008] In a work vehicle according to one aspect of the present invention, a vehicle body is suspended from a rope body between a first fixed pulley and a fixed object, and a movable pulley fixed to the vehicle body is suspended from a rope body between the first fixed pulley and a second fixed pulley. With this configuration, the gravity acting on the vehicle body can be supported using the portion of the rope body connecting the first fixed pulley to the movable pulley, the portion of the rope body connecting the second fixed pulley to the movable pulley, the portion of the rope body connecting the fixed object to the vehicle body, and the portion of the rope body connecting the second fixed pulley to the vehicle body. With this configuration, the tension in the rope body can be reduced compared to a configuration in which the vehicle body is simply suspended from a single rope body connecting a winding section to a fixed object. This reduces the torque required by the motor at the winding section that winds the rope body. As a result, the required torque can be met even with a motor with lower torque.
[0009] The device further includes a control unit for controlling the winding unit and the vehicle body unit, and the winding unit has a reel that winds the rope body by rotating while the rope body is wound around it, a first motor that is a drive source for rotating the reel, a first motor drive control mechanism that controls the drive of the first motor, and a winding amount detection unit that detects information related to the winding amount of the rope body wound by the reel, and the vehicle body has a second motor that is a drive source for moving the vehicle body along the extension direction of the rope body, a second motor drive control mechanism that controls the drive of the second motor, and a movement amount detection unit that detects information related to the movement amount of the vehicle body relative to the rope body, and the control unit may output a first control signal to the first motor drive control mechanism and a second control signal to the second motor drive control mechanism so that the vehicle body moves to a predetermined position based on the information related to the winding amount of the rope body and the information related to the movement amount of the vehicle body. In this way, the control unit outputs control signals to the first motor drive control mechanism and the second motor drive control mechanism based on predetermined information, automating the winding of the rope body and the movement of the vehicle body, making it easier to control the work vehicle. Furthermore, by taking into account the amount of winding of the rope body wound by the reel and the amount of movement of the vehicle body relative to the rope body, it becomes possible to estimate, for example, the current position of the vehicle body. Based on this information, an appropriate control signal can be output so that the vehicle body moves to a predetermined position. As described above, with the above-described configuration, it is possible to appropriately control the winding unit and the vehicle body, and to move the vehicle body to a predetermined position with high precision.
[0010] The work vehicle may further include a control unit for controlling the winding unit and the vehicle body unit, the winding unit having a reel that rotates with the rope body wound thereon to wind the rope body, a first motor that is a drive source for rotating the reel, and a first motor drive control mechanism that controls the drive of the first motor, the vehicle body having a second motor that is a drive source for moving the vehicle body along the extension direction of the rope body and a second motor drive control mechanism that controls the drive of the second motor, and the control unit may output a first control signal to the first motor drive control mechanism and a second control signal to the second motor drive control mechanism in accordance with at least the position of the first fixed pulley relative to the fixed object and the second fixed pulley. In this way, the control unit outputs control signals to the first motor drive control mechanism and the second motor drive control mechanism based on predetermined information, thereby automating the winding of the rope body and the movement of the vehicle body unit and making it easier to control the work vehicle. In addition, there are cases where it is necessary to change the control content for the winding unit and the vehicle body unit depending on the position of the first fixed pulley (i.e., the winding unit), and by outputting the first control signal and the second control signal depending on the position of the first fixed pulley relative to the fixed object and the second fixed pulley, the winding unit and the vehicle body unit can be controlled appropriately depending on the configuration of the work vehicle.
[0011] The control unit may perform a first control in which, when the first fixed pulley is provided adjacent to the second fixed pulley, the second motor rotates in a first direction to move the vehicle body in a direction toward the fixed object, and simultaneously outputs a first control signal to cause the reel to lengthen the rope. When the first fixed pulley is provided adjacent to the second fixed pulley, the movement of the vehicle body moving in the direction toward the fixed object may be limited due to the length of the rope connected to the movable pulley. In this regard, by extending the rope by the reel at the same time as the vehicle body moves, the vehicle body can be moved appropriately without being limited by the length of the rope.
[0012] The control unit may perform second control in which, when the first fixed pulley is provided adjacent to the fixed object, the control unit outputs a second control signal so that the second motor rotates in the first direction to move the car body in a direction toward the fixed object without outputting the first control signal. In this way, when the first fixed pulley is provided on the side of the fixed object and the car body can move in a direction toward the fixed object without winding or unwinding the rope body, the control is simplified and the amount of processing can be reduced by outputting the second control signal so that the car body moves in a state where the first control signal is not output.
[0013] The winding unit further includes a winding length detection unit that detects information related to the winding length of the rope body wound by the reel. When the first fixed pulley is provided near the midpoint between the fixed object and the second fixed pulley, the control unit may determine the winding length of the rope body based on the information related to the winding length of the rope body detected by the winding length detection unit, and may implement either the first control or the second control depending on the winding length of the rope body. When the first fixed pulley is provided near the midpoint between the fixed object and the second fixed pulley, the winding length of the rope body determines whether the movement of the body unit moving in the direction toward the fixed object is likely to be restricted or not. In this regard, by switching between control when the movement of the body unit is restricted (first control) and control when the movement of the body unit is not restricted (second control) depending on the winding length of the rope body, the body unit can be moved appropriately while preventing the rope body from being unnecessarily stretched.
[0014] In a control method for a work vehicle according to one aspect of the present invention, a computer that controls the work vehicle outputs a first control signal to the winding unit and a second control signal to the body unit so that the body unit moves to a predetermined position based on information related to the winding amount of the rope body and information related to the movement amount of the body unit. This control method makes it possible to reduce the torque required by the motor in the winding unit of the work vehicle.
[0015] A program for a work vehicle according to one aspect of the present invention causes a computer that controls the work vehicle to output a first control signal to the winding unit and a second control signal to the body unit so that the body unit moves to a predetermined position based on information related to the amount of winding of the rope body and information related to the amount of movement of the body unit. Such a program can reduce the torque required by the motor in the winding unit of the work vehicle. [Effects of the Invention]
[0016] According to one aspect of the present invention, it is possible to provide a work vehicle, a control method, and a program that can reduce the torque required by the motor in the winding section. [Brief explanation of the drawings]
[0017] [Figure 1] 1 is a schematic diagram showing an image of a work vehicle according to a first embodiment in operation; [Figure 2] 1 is a schematic diagram showing an image of a work vehicle according to a first embodiment in operation; [Figure 3] 1 is a block diagram illustrating an example of the hardware configuration of a work vehicle according to a first embodiment. [Figure 4] FIG. 2 is a block diagram showing the functions of a control unit. [Figure 5] FIG. 10 is a schematic diagram showing an image of a work vehicle according to a modified example. [Figure 6] FIG. 10 is a schematic diagram showing an image of a work vehicle according to a modified example. [Figure 7] 10 is a flowchart showing a processing procedure in a work vehicle according to a second embodiment. [Figure 8] FIG. 10 is a diagram for explaining a method for estimating the current position of a vehicle body in a work vehicle according to a second embodiment. [Figure 9] 10 is a flowchart showing a processing procedure in a work vehicle according to a third embodiment. DETAILED DESCRIPTION OF THE INVENTION
[0018] Hereinafter, embodiments of a work vehicle, a work vehicle control method, and a program will be described with reference to the drawings. In the description, identical elements or elements having identical functions are designated by the same reference numerals, and redundant description will be omitted.
[0019] [First embodiment] 1 and 2 are schematic diagrams showing an image of a work image of a work vehicle 1 according to a first embodiment. FIG. 1 is a perspective view of the work vehicle 1 positioned in a work area W on a slope. FIG. 2 is a side view of the work vehicle 1 positioned in the work area W on a slope. As shown in FIGS. 1 and 2, the work vehicle 1 is a vehicle for mowing grass in the work area W on a slope while moving. The work area W is a slope having an upper portion W1 and a lower portion W2, and slopes downward from the upper portion W1 to the lower portion W2. Specifically, the work area W is, for example, a slope of a ridge in a paddy field, but is not limited to this and may be a slope of a developed land or a slope of a levee. The work area W is, for example, a steep slope with a maximum gradient of 30 to 50 degrees or more (see FIG. 2), but is not limited to this and may be a gentler slope. Hereinafter, the horizontal direction in the work area W is defined as the X direction, and the direction perpendicular to the X direction in the work area W is defined as the Y direction.
[0020] The work vehicle 1 comprises a wire 2 (rope body), a winding unit 3, a first fixed pulley 4, a second fixed pulley 5, a movable pulley 6, and a vehicle body unit 7. One end of the wire 2 is fixed to a fixed object P1, and the other end is connected to the winding unit 3.
[0021] The second fixed pulley 5 and fixed object P1 are provided at the top W1 of the slope near the working area W. The second fixed pulley 5 and fixed object P1 are provided, for example, at both ends of the top W1 in the X direction. The unwinding unit 3 and the first fixed pulley 4 are provided at the top W1 of the slope near the working area W. The unwinding unit 3 and the first fixed pulley 4 are provided so as to be located between the second fixed pulley 5 and the fixed object P1 in the X direction. The first fixed pulley 4 is provided near the unwinding unit 3. In the example shown in FIG. 1, the first fixed pulley 4 is provided so as to be adjacent to the second fixed pulley 5.
[0022] The wire 2 is a rope with one end fixed to the fixed object P1, for example, a wire made of woven metal wires. The wire 2 may be a metal wire, a cord or rope made of woven natural materials, synthetic fibers, composite materials, resin materials, or the like, or a rope made of resin. One end of the wire 2 is formed, for example, in a loop shape and is hooked onto and supported by the fixed object P1 fixed to the ground. A snap hook or other support member for hooking onto the fixed object P1 may be connected to one end of the wire 2. The other end of the wire 2 is connected to a winding unit 3. The wire 2 extends from the other end toward the one end so as to form a first fixed pulley 4, a movable pulley 6, a second fixed pulley 5, and a car body unit 7.
[0023] The fixed object P1 is, for example, a stake driven into the ground at the top W1 or midway of the work area W or a slope near the work area W. The fixed object P1 may be a guardrail, a tree, or other structure in addition to a stake. The stake is, for example, a steel rod with reinforcing bars or the like processed into it. The stake is, for example, inserted into a polyvinyl chloride pipe that has been buried in the ground in advance. The stake may also be driven directly into the ground. In addition to a steel rod, any other object may be used as long as it can support one end of the wire 2.
[0024] The unwinding unit 3 is provided at the other end of the wire 2 and unwinds the wire 2. Fig. 3 is a block diagram illustrating an example of the hardware configuration of the work vehicle 1. As shown in Fig. 3, the unwinding unit 3 has a reel 31, a first motor 32, a first motor driver (first motor drive control mechanism) 33, and a first encoder (unwinding amount detection unit) 34.
[0025] The reel 31 rotates with the wire 2 wound thereon to unwind the wire 2. The other end of the wire 2 is wound around the reel 31. The first motor 32 is a drive source that rotates the reel 31. The first motor driver 33 controls the driving of the first motor 32 under the control of the control unit 8, which will be described later. The first encoder 34 detects information related to the amount of winding of the wire 2 wound by the reel 31. The first encoder 34 may be, for example, a rotary encoder, and may detect the rotation of the first motor 32. The first encoder 34 outputs the detected information related to the amount of winding of the wire 2 to the control unit 8. Note that instead of the first motor driver 33, a configuration such as a motor controller or a motor control IC (another configuration capable of controlling the driving of the first motor 32) may be employed.
[0026] Returning to FIG. 1 , the first fixed pulley 4 is provided near the unwinding unit 3 and is a fixed pulley that guides the wire 2 being unwound by the unwinding unit 3. The first fixed pulley 4 is provided, for example, at a position where it guides the wire 2 toward the unwinding unit 3 just before it is wound by the unwinding unit 3 (i.e., where it guides the wire 2 just after it is unwound from the unwinding unit 3). In the example shown in FIG. 1 , the unwinding unit 3 is adjacent to the first fixed pulley 4, but this is not limiting. The unwinding unit 3 only needs to be provided so that the wire 2 between the unwinding unit 3 and the first fixed pulley 4 does not interfere with the movement of the movable pulley 6 and the car body 7. For example, the unwinding unit 3 may be provided at a position away from the first fixed pulley 4 at the top W1 of the working area W, or may be provided outside the space between the second fixed pulley 5 and the fixed object P1, or may be provided at another position that does not interfere with the movement of the movable pulley 6 and the car body 7. The second fixed pulley 5 guides the wire 2 between the fixed object P1 and the first fixed pulley 4.
[0027] The movable pulley 6 is fixed to the car body 7. The movable pulley 6 is suspended from the wire 2 between the first fixed pulley 4 and the second fixed pulley 5, and moves in response to the winding of the wire 2 by the winding unit 3. Specifically, the movable pulley 6 moves within the working area W together with the car body 7, which will be described later. When the movable pulley 6 moves as a result of the wire 2 being wound by the winding unit 3, the length of the wire 2 between the first fixed pulley 4 and the movable pulley 6 and the length of the wire 2 between the second fixed pulley 5 and the movable pulley 6 change. The first fixed pulley 4, the second fixed pulley 5, and the movable pulley 6 then rotate so that the wire 2 between the first fixed pulley 4 and the movable pulley 6 and the wire 2 between the second fixed pulley 5 and the movable pulley 6 are of appropriate lengths. At this time, tension is generated in the wire 2 between the first fixed pulley 4 and the movable pulley 6, and in the wire 2 between the second fixed pulley 5 and the movable pulley 6. As a result, the portion of the wire 2 connecting from the first fixed pulley 4 to the movable pulley 6 and the portion of the wire 2 connecting from the second fixed pulley 5 to the movable pulley 6 support the movable pulley 6, thereby being able to support the gravity acting on the car body 7.
[0028] The car body 7 moves on the wire 2 between the fixed object P1 and the second fixed pulley 5 in the direction in which the wire 2 extends. The car body 7 is suspended, for example, by the wire 2 over a working area W on a slope. The car body 7 is capable of moving over the working area W. The example shown in FIG. 1 shows how the wire 2 extends when the movable pulley 6 and the car body 7 move to each position along the X direction.
[0029] As shown in FIG. 3, the body 7 has a second motor 71, a second motor driver (second motor drive control mechanism) 72, and a second encoder (movement amount detection unit) 73. The second motor 71 is a drive source for moving the body 7 along the extension direction of the wire 2. The second motor 71 is configured to move the body 7 relative to the wire 2. The second motor driver 72 controls the drive of the second motor 71 under the control of the control unit 8, which will be described later. This causes the body 7 to move along the wire 2. The second encoder 73 detects information related to the amount of movement of the body 7 relative to the wire 2. The second encoder 73 may be, for example, a rotary encoder and may detect the rotation of the second motor 71. The second encoder 73 outputs the detected information related to the amount of movement of the body 7 relative to the wire 2 to the control unit 8. A mowing blade (not shown) for mowing grass is provided on the underside of the body 7. The mowing blade may be, for example, a nylon cord cutter or a metal-free blade. Furthermore, in the first embodiment, the first encoder 34 and the second encoder 73 do not have to be provided on the work vehicle 1. Furthermore, the vehicle body 7 is provided with a plurality of wheels that movably support the vehicle body as it moves within the work area W. Furthermore, since the vehicle body 7 only needs to be able to move within the work area W, a sled for moving that movably supports the vehicle body as it moves within the work area W may be provided instead of the plurality of wheels.
[0030] Referring again to FIG. 1, when the work vehicle 1 begins to be used, one end of the wire 2 is unwound from the reel 31. The wire 2 passes through the first fixed pulley 4, the movable pulley 6, the second fixed pulley 5, and the vehicle body 7 in that order, and is then hooked onto and secured to the fixed object P1. At this time, tension is generated in the wire 2. With tension generated in the wire 2, the first motor 32 rotates the reel 31 forward or reverse, thereby adjusting the amount of winding and unwinding (extension) of the wire 2. Furthermore, the second motor 71 of the vehicle body 7 rotates forward or reverse, causing the vehicle body 7 to move over the wire 2 in the direction in which the wire 2 extends. As described above, the vehicle body 7 moves to a predetermined position in the work area W by unwinding the wire 2 and moving the vehicle body 7 relative to the wire 2.
[0031] FIG. 4 is a block diagram related to the functions of the control unit. As shown in FIG. 1, control information for the work vehicle 1 is received by the operation unit 300. As shown in FIG. 4, the operation unit 300 receives operations by the user and transmits control information for moving the work vehicle 1 to the control unit 8 via the communication unit 9. The operation unit 300, for example, communicates wirelessly with the communication unit 9. The operation unit 300 is, for example, a general-purpose mobile terminal device with a communication function, such as a tablet terminal, a smartphone, a notebook PC (Personal Computer), or a proportional radio. Alternatively, the operation unit 300 may be a desktop PC. The operation unit 300 may, for example, be a PC connected to a wired LAN that is connected to the Internet. In this way, the operation unit 300 may be any terminal that is capable of using browser software with a communication function. The operation unit 300 may be configured as a dedicated terminal.
[0032] The work vehicle 1 further includes a control unit 8, a communication unit 9, a drive unit 10, and a power supply unit 11. The communication unit 9 communicates between the control unit 8 and external devices. The communication unit 9 transmits control information from the operation unit 300 to the control unit 8. The drive unit 10 is configured to drive a cutting blade (not shown) for mowing grass in accordance with the control of the control unit 8. The power supply unit 11 is a power source that supplies power to various devices in the work vehicle 1.
[0033] The control unit 8 controls the drive unit 10 for mowing, and also controls the winding unit 3 and the vehicle body unit 7. The control unit 8 controls the first motor driver 33 and the second motor driver 72 based on control information received from the operation unit 300 via the communication unit 9. As an example, two control units 8 are provided in the first motor driver 33 and the second motor driver 72, respectively. The control units 8 are connected to each other via wireless communication or the like so that they can send and receive information. The operation unit 300 accesses one control unit 8 via wireless communication or the like and sends commands to the other control unit 8 via the one control unit 8. For example, the operation unit 300 may send control information (commands) to the control unit 8 provided in the second motor driver 72 via the control unit 8 provided in the first motor driver 33, or may send control information (commands) to the control unit 8 provided in the first motor driver 33 via the control unit 8 provided in the second motor driver 72. The operation unit 300 and each control unit 8 may be connected to the Internet via a mobile phone line or the like. In this case, the operation unit 300 may send commands (directly) to each control unit 8 via an Internet line. Furthermore, each control unit 8 and the operation unit 300 may be connected to each other so as to be able to send and receive information to and from each other. For example, each control unit 8 and the operation unit 300 may be connected to each other via the Internet, a wide area network (WAN), a local area network (LAN), a wireless network, or short-range wireless communication. Short-range wireless communication includes Bluetooth (registered trademark) or Wi-Fi, etc. Furthermore, similarly to the above, each control unit 8 may be connected to each other so as to be able to send and receive information to and from each other.
[0034] The control information is information generated based on an operation input by the user to the operation unit 300, and is, for example, at least one of information indicating that the first motor 32 is to rotate forward or backward and information indicating that the second motor 71 is to rotate forward or backward. In other words, the user controls the first motor driver 33 and the second motor driver 72 via the operation unit 300 while actually viewing the vehicle body 7. In this way, the user controls the winding of the wire 2 and the movement of the vehicle body 7 relative to the wire 2, thereby controlling the movement of the vehicle body 7 in the working area W. Note that the user may also control the first motor driver 33 and the second motor driver 72 via the operation unit 300 while checking the vehicle body 7 via a camera or the like.
[0035] The control unit 8 may acquire the amount of winding of the wire 2 wound by the reel 31 from the first encoder 34. In this case, the control unit 8 may identify the amount of winding of the wire 2 based on information related to the amount of winding of the wire 2 wound by the reel 31, and present the amount of winding to the user via the operation unit 300. The control unit 8 may acquire information related to the amount of movement of the vehicle body unit 7 relative to the wire 2 from the second encoder 73. In this case, the control unit 8 may identify the amount of movement of the vehicle body unit 7 relative to the wire 2 based on information related to the amount of movement of the vehicle body unit 7 relative to the wire 2, and present the amount of movement to the user via the operation unit 300.
[0036] 3, the control unit 8 is configured by one or more control computers. The control unit 8 has a circuit 190. The circuit 190 includes at least one processor 191, a memory 192, a storage 193, an input / output port 194, an input device 195, and a display device 196.
[0037] The storage 193 includes a computer-readable storage medium such as a hard disk, etc. The storage 193 stores a program for causing the control unit 8 to execute processing based on control information received from the operation unit 300.
[0038] The memory 192 temporarily stores programs loaded from the storage medium of the storage 193 and calculation results by the processor 191. The processor 191 configures the above-mentioned functional modules by executing the programs in cooperation with the memory 192. The input / output port 194 inputs and outputs electrical signals between the communication unit 9, the power supply unit 11, the first motor driver 33, the first encoder 34, the second motor driver 72, the second encoder 73, and the drive unit 10 in response to commands from the processor 191.
[0039] The input device 195 and the display device 196 function as a user interface for the control unit 8. The input device 195 is, for example, a keyboard, and acquires information input by the user. The display device 196 includes, for example, a liquid crystal monitor, and is used to display information to the user. The input device 195 and the display device 196 may be integrated as a so-called touch panel.
[0040] Next, the effects of the work vehicle 1 according to the first embodiment will be described.
[0041] The work vehicle 1 of the first embodiment comprises a wire 2 having one end fixed to a fixed object P1, a winding unit 3 provided at the other end of the wire 2 and winding the wire 2, a first fixed pulley 4 provided near the winding unit 3 and guiding the wire 2 being wound by the winding unit 3, a second fixed pulley 5 that guides the wire 2 between the fixed object P1 and the first fixed pulley 4, a body unit 7 that moves on the wire 2 between the fixed object P1 and the second fixed pulley 5 in the extension direction of the wire 2, and a movable pulley 6 fixed to the body unit 7, suspended from the wire 2 between the first fixed pulley 4 and the second fixed pulley 5, and moving in accordance with the winding of the wire 2 by the winding unit 3.
[0042] In the work vehicle 1 according to the first embodiment, the vehicle body 7 is suspended from the wire 2 between the first fixed pulley 4 and the fixed object P1, and the movable pulley 6 fixed to the vehicle body 7 is suspended from the wire 2 between the first fixed pulley 4 and the second fixed pulley 5. With this configuration, the gravity acting on the vehicle body 7 can be supported using the portion of the wire 2 connecting the first fixed pulley 4 to the movable pulley 6, the portion of the wire 2 connecting the second fixed pulley 5 to the movable pulley 6, the portion of the wire 2 connecting the fixed object P1 to the vehicle body 7, and the portion of the wire 2 connecting the second fixed pulley 5 to the vehicle body 7. With this configuration, the tension in the wire 2 can be reduced compared to, for example, a configuration in which the vehicle body 7 is suspended from a single wire 2 simply connecting the reeling unit 3 to the fixed object P1. This reduces the torque required of the first motor 32 in the reeling unit 3 that reel in the wire 2, allowing a motor with lower torque to meet the required torque. As a result, it is possible to achieve a lighter weight work vehicle 1 and improved mobility (high mobility).
[0043] The above-mentioned effects will be explained in detail. The work vehicle according to the comparative example does not have a movable pulley 6 or a second fixed pulley 5, and the vehicle body 7 is suspended from the wire 2 between the first fixed pulley 4 and the fixed object P1. Below, the tension of the wire 2 in the work vehicle according to the comparative example will be compared with the tension of the wire 2 in the work vehicle 1 according to the first embodiment. The tension of the wire 2 is measured assuming that the weight of the vehicle body 7 is 17.6 kgf. In the work vehicle according to the comparative example, when the distance between the first fixed pulley 4 and the fixed object P1 is 280 cm and the vehicle body 7 is located 140 cm from the first fixed pulley 4 in the X direction and 136.5 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 12.3 kgf.
[0044] In contrast, in the work vehicle 1 according to the first embodiment, when the distance between the second fixed pulley 5 and the fixed object P1 is 280 cm and the vehicle body 7 is located 0 cm from the second fixed pulley 5 in the X direction (see the left side of FIG. 1) and 138 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 9.6 kgf. When the vehicle body 7 is located 140 cm from the second fixed pulley 5 in the X direction (see the center of FIG. 1) and 136.5 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 8.3 kgf. When the vehicle body 7 is located 280 cm from the second fixed pulley 5 in the X direction (see the right side of FIG. 1) and 135 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 5.5 kgf. The tension of the wire 2 was measured using a force gauge (manufactured by Imada Corporation). Specifically, first, a force gauge is connected to the other end of the wire 2 instead of the winding unit 3. Then, when the force pulling the wire 2 is gradually increased, the maximum value (load) measured by the force gauge before the car body unit 7 starts to move is taken as the tension of the wire 2.
[0045] For the reasons described above, compared to the work vehicle according to the comparative example, the work vehicle 1 according to the first embodiment can reduce the tension of the wire 2. This reduces the torque required of the first motor 32 in the winding section 3 that winds up the wire 2.
[0046] In the work vehicle 1 according to the first embodiment, the winding unit 3 is provided at the top W1 of the working area W, rather than in the vehicle body 7. This allows the vehicle body 7 to be made lighter than when the structure for winding the wire 2 is provided in the vehicle body 7. As a result, the mobility of the vehicle body 7 can be increased.
[0047] In the work vehicle 1 according to the first embodiment, the first fixed pulley 4 is provided adjacent to the second fixed pulley 5, but this is not limiting. For example, as in the work vehicle 1 according to a modified example shown in FIG. 5, the first fixed pulley 4 may be provided adjacent to the fixed object P1. In this case, when the distance between the second fixed pulley 5 and the fixed object P1 is 280 cm in the work vehicle 1, the tension of the wire 2 is, for example, 7.3 kgf when the body 7 is located 0 cm from the second fixed pulley 5 in the X direction (see the left side of FIG. 5) and 138 cm from the top W1 in the Y direction. When the body 7 is located 140 cm from the second fixed pulley 5 in the X direction (see the center of FIG. 5) and 136.5 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 11.8 kgf. When the vehicle body 7 is located 280 cm (see the right side of FIG. 5) from the second fixed pulley 5 in the X direction and 135 cm from the top W1 in the Y direction, the tension in the wire 2 is, for example, 7.8 kgf. From the above, compared to the work vehicle according to the comparative example, the work vehicle 1 according to the modified example shown in FIG. 5 can reduce the tension in the wire 2. This makes it possible to reduce the torque required for the first motor 32 in the winding unit 3 that winds up the wire 2.
[0048] Furthermore, for example, as in a work vehicle 1 according to a modified example shown in Fig. 6, the first fixed pulley 4 may be provided near the midpoint between the fixed object P1 and the second fixed pulley 5. In this case, when the distance between the second fixed pulley 5 and the fixed object P1 is 280 cm in the work vehicle 1, the tension of the wire 2 is, for example, 7.7 kgf when the body 7 is located 0 cm from the second fixed pulley 5 in the X direction (see the left side of Fig. 6) and 138 cm from the top W1 in the Y direction. When the body 7 is located 140 cm from the second fixed pulley 5 in the X direction (see the center of Fig. 6) and 136.5 cm from the top W1 in the Y direction, the tension of the wire 2 is, for example, 9.8 kgf. When the vehicle body 7 is located 280 cm (see the right side of FIG. 6) from the second fixed pulley 5 in the X direction and 135 cm from the top W1 in the Y direction, the tension in the wire 2 is, for example, 7.0 kgf. From the above, it is possible to reduce the tension in the wire 2 in the work vehicle 1 according to the modified example shown in FIG. 6 compared to the work vehicle according to the comparative example. This makes it possible to reduce the torque required for the first motor 32 in the winding section 3 that winds up the wire 2. Note that the vicinity of the midpoint may be the midpoint between the fixed object P1 and the second fixed pulley 5, or a position shifted from the midpoint.
[0049] Furthermore, when the first fixed pulley 4 is disposed in the center between the second fixed pulley 5 and the fixed object P1 (see FIG. 6), the variation (change) in the tension of the wire 2 at the winding unit 3 when the car body 7 moves is smaller than when the first fixed pulley 4 is adjacent to the second fixed pulley 5 or the fixed object P1 (see FIGS. 1 and 5). Therefore, by disposing the first fixed pulley 4 in the center between the second fixed pulley 5 and the fixed object P1, the torque required of the first motor 32 at the winding unit 3 that winds the wire 2 can be reduced.
[0050] Furthermore, in the work vehicle 1 according to the first embodiment, one movable pulley 6 is suspended from the wire 2 between the first fixed pulley 4 and the second fixed pulley 5, but the number of movable pulleys 6 is not limited to this. For example, a plurality of movable pulleys 6 fixed to the vehicle body 7 may be suspended from the wire 2 between the first fixed pulley 4 and the second fixed pulley 5. As an example, a third fixed pulley may be further provided between the first fixed pulley 4 and the second fixed pulley 5. In this case, the first movable pulley may be suspended from the wire 2 between the first fixed pulley 4 and the third fixed pulley, and the second movable pulley may be suspended from the wire 2 between the third fixed pulley and the second fixed pulley 5.
[0051] Furthermore, in the work vehicle 1 according to the first embodiment, the first fixed pulley 4 and the second fixed pulley 5 may be fixed to each support pole as shown in Fig. 1, or may be fixed to a single support pole. In the work vehicle 1 according to the modified example, the first fixed pulley 4 may be fixed to a support pole as shown in Fig. 5, or may be fixed to a fixed object P1.
[0052] [Second embodiment] A control unit 8A included in a work vehicle 1A according to the second embodiment will be described. In the second embodiment, explanations common to the first embodiment will be omitted, and differences from the first embodiment will be mainly described.
[0053] The control unit 8A controls the drive unit 10 as a control related to mowing, and also controls the winding unit 3 and the vehicle body unit 7. The control unit 8A outputs a first control signal to the first motor driver 33 and outputs a second control signal to the second motor driver 72. The first control signal is a signal that indicates that the first motor 32 should rotate forward or backward. The second control signal is a signal that indicates that the second motor 71 should rotate forward or backward.
[0054] Unlike the first embodiment, the control unit 8A automatically controls the unwinding unit 3 and the vehicle body unit 7. Specifically, the control unit 8A outputs a first control signal to the first motor driver 33 and a second control signal to the second motor driver 33 based on information related to the amount of unwinding of the wire 2 and information related to the amount of movement of the vehicle body unit 7, so that the vehicle body unit 7 moves to a predetermined position.
[0055] Figure 7 is a flowchart showing the processing procedure in the work vehicle 1A according to the second embodiment. The processing in the work vehicle 1A will be explained in detail below. When mowing work in the work area W, the user sets the work vehicle 1A in the work area W. Then, in the work vehicle 1A, when the control unit 8A receives a signal from the operation unit 300 instructing the start of mowing work, the following processing is executed.
[0056] First, the control unit 8A acquires various pieces of information (step S01). Specifically, the control unit 8A acquires the distance L1 (see FIG. 1) between the second fixed pulley 5 and the fixed target P1 in the working area W. The control unit 8A acquires the distance L2 between the first fixed pulley 4 and the second fixed pulley 5. The control unit 8A acquires the length H of the working area W along the Y direction. The control unit 8A may set the above-mentioned various pieces of information in advance, or may acquire the information from outside using a sensor or the like. Alternatively, the user may input the above-mentioned various pieces of information to the operation unit 300, and the inputted various pieces of information may be transmitted to the control unit 8A.
[0057] Next, the control unit 8A sets a movement path for the body unit 7 based at least on the distance L1 and the length H (step S02). Specifically, the control unit 8A sets a movement path for the body unit 7 in the working area W. More specifically, the control unit 8A sets the distance L1 as the movement distance of the body unit 7 in one movement along the X direction. The control unit 8A sets a descent distance, which is the distance the body unit 7 moves along the Y direction toward the bottom W2 (see FIG. 1) of the working area W. The control unit 8A sets the number of movements of the body unit 7 in the X direction based at least on the descent distance and the length H. As described above, the control unit 8A sets a movement path so that the body unit 7 repeatedly moves in the X direction the set number of times, and passes through the entire working area W.
[0058] For example, the control unit 8 sets a movement path so that movement is performed as follows based on the set number of movements. As one example, the vehicle body unit 7 moving along the movement path performs the above-mentioned one movement along the X direction from one end of the working area W to the other end. At the other end, the vehicle body unit 7 moves a descending distance along the Y direction toward the bottom W2 of the working area W. The vehicle body unit 7 performs the above-mentioned one movement along the X direction from the other end of the working area W to one end. At one end, the vehicle body unit 7 moves a descending distance along the Y direction toward the bottom W2 of the working area W. The vehicle body unit 7 repeatedly performs the above-mentioned movement based on the preset number of movements.
[0059] The descent distance may be a distance equal to the width in the Y direction of the mowing area, which is the area where mowing is performed by the vehicle body unit 7. The descent distance may also be a distance shorter than this width. For example, the control unit 8A may acquire overlap information, which is information indicating the degree of overlap of the areas through which the mowing areas pass. In this case, the descent distance may be set to a distance shorter than the width in the Y direction of the mowing area based on the overlap information. The overlap information may be set in advance by the control unit 8A or may be set by the user.
[0060] Next, the control unit 8A identifies the winding amount of the wire 2 (step S03). Specifically, the control unit 8A stores in advance the correspondence between the winding amount of the wire 2 around the reel 31 and the rotation amount of the first motor 32. The control unit 8A acquires the rotation amount of the first motor 32 from the first encoder 34 as information related to the winding amount of the wire 2. The control unit 8A identifies the winding amount of the wire 2 based on the rotation amount.
[0061] Next, the control unit 8A identifies the amount of movement of the body unit 7 relative to the wire 2 (step S04). Specifically, the control unit 8A stores in advance a correspondence between the amount of movement of the body unit 7 relative to the wire 2 and the amount of rotation of the second motor 71. The control unit 8A acquires the amount of rotation of the second motor 71 from the second encoder 73 as information related to the amount of movement of the body unit 7 relative to the wire 2. The control unit 8A identifies the amount of movement of the body unit 7 relative to the wire 2 based on the amount of rotation.
[0062] Next, the control unit 8A estimates the current position of the body unit 7 in the working area W (step S05). Specifically, the control unit 8A estimates the current position of the body unit 7 based on the amount of winding of the wire 2 and the amount of movement of the body unit 7 relative to the wire 2. FIG. 8 is a schematic diagram for explaining a method for estimating the current position of the body unit 7 by the control unit 8A. In FIG. 8, the position of the second fixed pulley 5 is the origin A (0,0), the position of the first fixed pulley 4 is point R (L2,0), the position of the fixed target P1 is point B (L1,0), and the position of the body unit 7 is point P (x,y). Furthermore, the length of the wire 2 between the second fixed pulley 5 and the car body 7 and the length of the wire 2 between the second fixed pulley 5 and the movable pulley 6 (distance between AP) are defined as a, the length of the wire 2 between the fixed object P1 and the movable pulley 6 (distance between BP) is defined as b1, and the length of the wire 2 between the first fixed pulley 4 and the movable pulley 6 (distance between RP) is defined as b2. The amount of movement of the car body 7 relative to the wire 2 is defined as ENC1, and the amount of stretching of the wire 2 is defined as ENC2. Note that L1 and L2 are preset constants, and x, y, a, b1, b2, ENC1, and ENC2 are variables. The amount of movement ENC1 of the car body 7 relative to the wire 2 is positive on the side of point B, and the amount of stretching of the wire 2 ENC2 is positive. Also, for the sake of simplicity, the length of the wire 2 between the second fixed pulley 5 and the body 7 and the length of the wire 2 between the second fixed pulley 5 and the movable pulley 6 are approximately the same.
[0063] If the initial position of the body 7 is point P(0,0), then the distance between AP is a=0, the distance between BP is b1=L1, and the distance between RP is b2=L2. Now, let's assume that the body 7 moves to point P(x,y). At this time, the relationships between the constants and variables are expressed as in the following equations (1) to (5). b1=L1-ENC1 …(1) 2a+b1+b2=L1+L2+ENC2 …(2) x 2 +y 2 -a 2 =0 …(3) (L1-x) 2 +y 2 -b1 2 =0 …(4) (L2-x)2 +y 2 -b2 2 =0 …(5)
[0064] The control unit 8A acquires in advance the distance L1 between the fixed object P1 and the second fixed pulley 5 and the distance L2 between the first fixed pulley 4 and the second fixed pulley 5 (step S01). The control unit 8A can determine the amount of extension ENC1 of the wire 2 and the amount of movement ENC2 of the car body unit 7 relative to the wire 2 (steps S03 and S04). From the above, equations (1) to (5) can be considered as five simultaneous equations including five variables x, y, a, b1, and b2, and the solutions for x, y, a, b1, and b2 are uniquely determined. Therefore, the point P(x, y), which is the position of the car body unit 7, is uniquely determined. From the above, the control unit 8A can estimate the point P(x, y), which is the current position of the car body unit 7, based on the amount of extension ENC1 of the wire 2 and the amount of movement ENC2 of the car body unit 7 relative to the wire 2.
[0065] Next, the control unit 8A outputs a first control signal to the first motor driver 33 and a second control signal to the second motor driver 33 so that the body unit 7 moves to a predetermined position (step S06). Specifically, the control unit 8A identifies a predetermined position to which the body unit 7 will move next based on the set movement path of the body unit 7 and the current position of the body unit 7. The control unit 8A outputs the first control signal and the second control signal so that the body unit 7 moves to the predetermined position.
[0066] This will be explained with reference to FIG. 8. The control unit 8A sets the movement path of the vehicle body unit 7 (step S02), thereby identifying a predetermined position P(x, y) to which the vehicle body unit 7 should move next based on its current position. At this time, equations (1) to (5) can be considered as five simultaneous equations including five variables, ENC1, ENC2, a, b1, and b2, and therefore the solutions to ENC1, ENC2, a, b1, and b2 are uniquely determined. In other words, once the predetermined position P(x, y) is identified, it is possible to identify the amount of movement ENC1 of the vehicle body unit 7 relative to the wire 2 and the amount of winding ENC2 of the wire 2 that are necessary for the vehicle body unit 7 to move to the predetermined position. The control unit 8A outputs a first control signal and a second control signal so as to realize the identified amount of movement ENC1 of the vehicle body unit 7 relative to the wire 2 and the identified amount of winding ENC2 of the wire 2.
[0067] Finally, the control unit 8A determines whether the vehicle body unit 7 has reached the end of the moving path (step S07). Specifically, when the vehicle body unit 7 moves to a predetermined position, the control unit 8A determines whether the predetermined position is the end of the moving path. If the control unit 8A determines that the vehicle body unit 7 has not reached the end of the moving path (step S07: NO), the control unit 8A again determines the amount of winding of the wire 2 and the amount of movement of the vehicle body unit 7 relative to the wire 2 (steps S03 and S04). If the control unit 8A determines that the vehicle body unit 7 has reached the end of the moving path (step S05: YES), the control unit 8A concludes that the mowing operation has ended and ends the process.
[0068] 3 stores a program for causing the control unit 8A to execute a control method for the work vehicle 1A. The control method for the work vehicle 1A is, for example, a control method in which the computer (control unit 8A) controlling the work vehicle 1A estimates the current position of the vehicle body 7 based on the specified amount of winding of the wire 2 and the amount of movement of the vehicle body 7 relative to the wire 2, and takes the estimation result into consideration and outputs control signals to the first motor driver 33 and the second motor driver 72 so that the vehicle body 7 is controlled to a desired position by winding the wire 2 and moving the vehicle body 7 relative to the wire 2. The program in this case is a program that causes the computer (control unit 8A) controlling the work vehicle 1A to estimate the position of the vehicle body 7 based on the specified amount of winding of the wire 2 and the amount of movement of the vehicle body 7 relative to the wire 2, and to output control signals to the first motor driver 33 and the second motor driver 72 so that the vehicle body 7 is controlled to a desired position by winding the wire 2 and moving the vehicle body 7 relative to the wire 2, taking the estimation result into consideration.
[0069] Next, the effects of the work vehicle 1A according to the second embodiment will be described.
[0070] The work vehicle 1A according to the second embodiment further includes a control unit 8A that controls the winding unit 3 and the vehicle body unit 7. The winding unit 3 includes a reel 31 that rotates with the wire 2 wound around it to wind up the wire 2, a first motor 32 that is a drive source for rotating the reel 31, a first motor driver 33 that controls the drive of the first motor 32, and a first encoder 34 that detects information related to the amount of winding of the wire 2 wound up by the reel 31. The vehicle body unit 7 further includes a control unit 8A that controls the winding unit 3 ... amount of winding of the wire 2 wound up by the reel 31. The control unit 8A has a second motor 71 which is a drive source for moving the body unit 7 along the extension direction of the wire 2, a second motor driver 72 which controls the drive of the second motor 71, and a second encoder 73 which detects information related to the amount of movement of the body unit 7 relative to the wire 2, and based on the information related to the amount of winding of the wire 2 and the information related to the amount of movement of the body unit 7, outputs a first control signal to the first motor driver 33 and a second control signal to the second motor driver 72 so that the body unit 7 moves to a predetermined position.
[0071] In the work vehicle 1A according to the second embodiment, the control unit 8A outputs control signals to the first motor driver 33 and the second motor driver 72 based on predetermined information, thereby automating the winding of the wire 2 and the movement of the vehicle body 7, making it easier to control the work vehicle 1A. By taking into consideration the amount of winding of the wire 2 wound by the reel 31 and the amount of movement of the vehicle body 7 relative to the wire 2, it becomes possible to estimate, for example, the current position of the vehicle body 7. Based on this information, an appropriate control signal can be output so that the vehicle body 7 moves to a predetermined position. As described above, with the above-described configuration, it is possible to appropriately control the winding unit 3 and the vehicle body 7, and to move the vehicle body to a predetermined position with high accuracy.
[0072] In the work vehicle 1A according to the second embodiment, by simultaneously controlling the first motor driver 33 of the winding unit 3 and the second motor driver 72 of the vehicle body unit 7 for a single wire 2 (a continuous rope), it is possible to move the vehicle body unit 7 (work equipment) to any position in two dimensions.
[0073] Note that the same control as in the second embodiment may also be performed in the work vehicles according to the modified examples shown in FIGS.
[0074] [Third embodiment] A control unit 8B included in a work vehicle 1B according to the third embodiment will be described. In the third embodiment, explanations common to the second embodiment will be omitted, and differences from the second embodiment will be mainly described.
[0075] The control unit 8B automatically controls the winding / unwinding unit 3 and the car body unit 7. Specifically, unlike the second embodiment, the control unit 8B outputs a first control signal and a second control signal according to the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5. In this way, the control unit 8B moves the car body unit 7 along the X direction.
[0076] Specifically, as shown in FIG. 1 , the control unit 8B performs the first control when the first fixed pulley 4 is disposed adjacent to the second fixed pulley 5. In the first control, when the car body 7 moves from one end of the working area W to the other end, the control unit 8B outputs a second control signal so that the second motor 71 rotates in the first direction to move the car body 7 in a direction toward the fixed target P1. At the same time, the control unit 8B outputs a first control signal so that the reel 31 stretches the wire 2. In the first control, the control unit 8B outputs the first control signal so that the wire 2 is stretched by an amount that does not restrict the movement of the car body 7. The amount of stretching may be any amount that does not restrict the movement of the car body 7. For example, the amount of stretching may be an amount that causes the car body 7 to move parallel to the X direction. For example, the amount of stretching may be an amount that causes the car body 7 to move in the Y direction so as to draw a convex curve toward the bottom W2.
[0077] In the first control, when the body 7 moves from the other end to one end of the working area W, the control unit 8B outputs a second control signal so that the second motor 71 rotates in the opposite direction to the first direction, thereby moving the body 7 in a direction away from the fixed object P1. At the same time, the control unit 8B outputs a first control signal so that the wire 2 is wound by the reel 31.
[0078] Specifically, the control unit 8B performs the second control when the first fixed pulley 4 is provided adjacent to the fixed object P1, as shown in Fig. 5. In the second control, when the body unit 7 moves from one end of the working space W to the other end, the control unit 8B outputs the second control signal so that the second motor 71 rotates in the first direction, causing the body unit 7 to move in the direction toward the fixed object P1, without outputting the first control signal. In this case, the body unit 7 moves in the Y direction, drawing a convex curve toward the bottom W2.
[0079] In addition, in the second control, when the vehicle body section 7 moves from the other side to one end of the work area W, the control section 8B outputs a second control signal so that the vehicle body section 7 moves in a direction away from the fixed object P1 by rotating the second motor 71 in the opposite direction to the first direction, without outputting the first control signal.
[0080] Specifically, as shown in FIG. 6 , when the first fixed pulley 4 is located near the midpoint between the fixed object P1 and the second fixed pulley 5, the control unit 8B determines the amount of extension of the wire 2 based on information related to the amount of extension of the wire 2 detected by the first encoder 34, and performs either the first control or the second control according to the amount of extension of the wire 2. More specifically, the control unit 8B estimates the current position of the car body 7 by determining the amount of extension of the wire 2 based on information related to the amount of extension of the wire 2. The control unit 8B performs the second control when the car body 7 is located closer to the second fixed pulley 5 than the first fixed pulley 4 in the X direction. The control unit 8B performs the first control when the car body 7 is located closer to the fixed object P1 than the first fixed pulley 4 in the X direction. The amount of extension of the wire 2 when the car body 7 is located directly below the first fixed pulley 4 is stored in advance as a threshold value. The control unit 8B can then appropriately switch between executing the first control and the second control by determining whether the winding amount of the wire 2 exceeds the threshold value. The threshold value may be set in advance by the control unit 8B or may be input in advance by the user.
[0081] Figure 9 is a flowchart showing the processing procedure in the work vehicle 1B according to the third embodiment. The processing in the work vehicle 1B will be explained in detail below. In the work vehicle 1B, when the control unit 8B receives a signal from the operation unit 300 instructing the start of mowing work, the following processing is executed. First, in the same way as in the second embodiment, the control unit 8B receives various pieces of information (step S01).
[0082] Next, the control unit 8B sets a movement path for the car body unit 7 based on the position and length H of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5 (step S02B). Specifically, in step S02B, the control unit 8B sets the movement of the car body unit 7 along the X direction from one end of the working area W to the other end in accordance with the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5 as one movement in the X direction. The control unit 8B sets a descent distance, which is the distance the car body unit 7 moves along the Y direction toward the bottom W2 of the working area W. The control unit 8B sets the number of movements of the car body unit 7 in the X direction based at least on the descent distance and length H. As described above, the control unit 8B sets a movement path such that the car body unit 7 repeatedly moves in the X direction based on the set number of movements, and the car body unit 7 passes through the entire working area W.
[0083] 1, the first fixed pulley 4 is provided adjacent to the second fixed pulley 5, and therefore the control unit 8B sets the path for the single movement so that the single movement is realized by performing the first control. In this case, the path along which the body unit 7 moves in the single movement is a path that describes a curve that is convex toward the bottom W2 side in the Y direction or a line segment that is parallel to the X direction.
[0084] 5, the first fixed pulley 4 is provided adjacent to the fixed object P1, so the control unit 8B sets the path for the single movement so that the single movement is realized by performing the second control. In this case, the path along which the body unit 7 moves in the single movement is a path that draws a convex curve toward the bottom W2 side in the Y direction.
[0085] In the example shown in Fig. 6, the first fixed pulley 4 is provided near the midpoint between the fixed object P1 and the second fixed pulley 5, and therefore the control unit 8B sets the path for the single movement so that the single movement is realized by performing the first control and the second control. In this case, when the car body 7 is positioned closer to the second fixed pulley 5 than the first fixed pulley 4 in the X direction, the second control is performed, and the path along which the car body 7 moves is a path that curves convexly toward the bottom W2 in the Y direction. Furthermore, when the car body 7 is positioned closer to the fixed object P1 than the first fixed pulley 4 in the X direction, the first control is performed, and the path along which the car body 7 moves is a path that curves convexly toward the bottom W2 in the Y direction or a line segment parallel to the X direction.
[0086] Next, as in the second embodiment, the control unit 8B identifies the amount of winding of the wire 2 (step S03), identifies the amount of movement of the vehicle body unit 7 relative to the wire 2 (step S04), and estimates the current position of the vehicle body unit 7 in the working area W (step S05). At this time, if the control unit 8B has previously performed the second control, it may identify only the amount of winding of the wire 2 (without executing step S04) and estimate the current position of the vehicle body unit 7. In this case, the second control does not change the amount of movement of the vehicle body unit 7 relative to the wire 2, so the control unit 8B does not need to newly identify the amount of movement of the vehicle body unit 7 relative to the wire 2 when estimating the current position of the vehicle body unit 7.
[0087] Next, as in the second embodiment, the control unit 8B outputs a first control signal to the first motor driver 33 and a second control signal to the second motor driver 34 so that the body unit 7 moves to a predetermined position (step S06). Finally, the control unit 8B determines whether the body unit 7 has reached the end of the movement path (step S07). If the control unit 8B determines that the body unit 7 has not reached the end of the movement path (step S07: NO), the control unit 8B again determines the amount of winding of the wire 2 (step S03). If the control unit 8B determines that the body unit 7 has reached the end of the movement path (step S05: YES), the control unit 8B determines that the mowing operation has ended and ends the process.
[0088] 3 stores a program for causing the control unit 8B to execute a control method for the work vehicle 1B. The control method for the work vehicle 1B is, for example, a control method in which the computer (control unit 8B) controlling the work vehicle 1B sets a movement path for the body unit 7 in accordance with the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5, and outputs control signals to the first motor driver 33 and the second motor driver 72 so that the body unit 7 moves along the movement path. The program in this case is a program that sets a movement path for the body unit 7 in accordance with the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5, and outputs control signals to the first motor driver 33 and the second motor driver 72 so that the body unit 7 moves along the movement path.
[0089] Next, the effects of the work vehicle 1B according to the third embodiment will be described.
[0090] The work vehicle 1B according to the third embodiment further includes a control unit 8B that controls the reeling unit 3 and the vehicle body unit 7. The reeling unit 3 has a reel 31 that rotates with the wire 2 wound around it to reel in the wire 2, a first motor 32 that is a drive source for rotating the reel 31, and a first motor driver 33 that controls the drive of the first motor 32. The vehicle body 7 has a second motor 71 that is a drive source for moving the vehicle body unit 7 along the extension direction of the wire 2, and a second motor driver 72 that controls the drive of the second motor 71. The control unit 8B outputs a first control signal to the first motor driver 33 and a second control signal to the second motor driver 72 in accordance with at least the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5. The control unit 8B outputs control signals to the first motor driver 33 and the second motor driver 72 based on predetermined information, thereby automating the reeling of the wire 2 and the movement of the vehicle body unit 7 and making it easier to control the work vehicle 1B. Furthermore, there are cases where it is necessary to change the control content for the winding unit 3 and the vehicle body unit 7 depending on the position of the first fixed pulley 4 (i.e., the winding unit 3). By outputting a first control signal and a second control signal depending on the position of the first fixed pulley 4 relative to the fixed object P1 and the second fixed pulley 5, the winding unit 3 and the vehicle body unit 7 can be controlled appropriately according to the configuration of the work vehicle 1B.
[0091] When the first fixed pulley 4 is provided adjacent to the second fixed pulley 5, the control unit 8B performs a first control, outputting a second control signal so that the second motor 71 rotates in the first direction to move the car body 7 in a direction toward the fixed object P1, and simultaneously outputting a first control signal so that the wire 2 is extended by the reel 31. When the first fixed pulley 4 is provided adjacent to the second fixed pulley 5, the movement of the car body 7 in the direction toward the fixed object P1 may be limited due to limitations on the length of the wire 2 connected to the movable pulley 6. In this regard, by extending the wire 2 by the reel 31 at the same time as the car body 7 moves, the car body 7 can be moved appropriately without being restricted by the length of the wire 2.
[0092] When the first fixed pulley 4 is provided adjacent to the fixed object P1, the control unit 8B performs second control by outputting a second control signal so that the second motor 71 rotates in the first direction to move the car body 7 in a direction toward the fixed object P1 without outputting the first control signal. In this way, when the first fixed pulley 4 is provided on the fixed object P1 side and the car body 7 can move in a direction toward the fixed object P1 without unwinding the wire 2, the control is simplified and the amount of processing can be reduced by outputting the second control signal so that the car body 7 moves in a state where the first control signal is not output.
[0093] The winding unit 3 further has a first encoder 34 that detects information related to the amount of winding of the wire 2 wound by the reel 31, and when the first fixed pulley 4 is provided near the midpoint between the fixed object P1 and the second fixed pulley 5, the control unit 8B identifies the amount of winding of the wire 2 based on the information related to the amount of winding of the wire 2 detected by the first encoder 34, and performs either the first control or the second control depending on the amount of winding of the wire 2. When the first fixed pulley 4 is provided near the midpoint between the fixed object P1 and the second fixed pulley 5, the amount of winding of the wire 2 determines whether the movement of the body unit 7 moving in the direction toward the fixed object P1 is easily restricted or is not easily restricted. In this regard, by switching between control in which the movement of the body section 7 is restricted (first control) and control in which the movement of the body section 7 is not restricted (second control) depending on the amount of winding of the wire 2, the body section 7 can be moved appropriately while preventing the wire 2 from being unnecessarily stretched.
[0094] Note that the same control as in the third embodiment may also be performed in the work vehicles according to the modified examples shown in FIGS. [Explanation of symbols]
[0095] 1, 1A, 1B...work vehicle, 2...wire (rope body), 3...winding section, 4...first fixed pulley, 5...second fixed pulley, 6...movable pulley, 7...vehicle body section, 8, 8A, 8B...control section, 31...reel, 32...first motor, 33...first motor driver (first motor drive control mechanism), 34...first encoder (winding amount detection section), 71...second motor, 72...second motor driver (second motor drive control mechanism), 73...second encoder (movement amount detection section), P1...fixed object.
Claims
1. a rope body having one end fixed to a fixed object; a winding section provided at the other end of the rope body and winding the rope body; a first fixed pulley provided near the winding section and guiding the rope body being wound by the winding section; A second fixed pulley that guides the rope body between the fixed object and the first fixed pulley; A vehicle body portion that moves on the rope body between the fixed object and the second fixed pulley along the extending direction of the rope body; A work vehicle comprising: a movable pulley that is fixed to the vehicle body portion, suspended on the rope body between the first fixed pulley and the second fixed pulley, and moves in accordance with the winding of the rope body by the winding portion.
2. Further, a control unit is provided to control the winding unit and the vehicle body unit. The winding unit includes a reel that rotates with the rope body wound around it to wind the rope body, a first motor that is a drive source that rotates the reel, a first motor drive control mechanism that controls the drive of the first motor, and a winding amount detection unit that detects information related to the winding amount of the rope body wound by the reel, The vehicle body section has a second motor which is a drive source for movement of the vehicle body section along the extension direction of the rope body, a second motor drive control mechanism which controls the drive of the second motor, and a movement amount detection section which detects information related to the movement amount of the vehicle body section relative to the rope body, 2. A work vehicle as described in claim 1, wherein the control unit outputs a first control signal to the first motor drive control mechanism and a second control signal to the second motor drive control mechanism so that the body section moves to a predetermined position based on information related to the amount of winding of the rope body and information related to the amount of movement of the body section.
3. Further, a control unit is provided to control the winding unit and the vehicle body unit. The winding unit includes a reel that rotates with the rope body wound around it to wind the rope body, a first motor that is a drive source that rotates the reel, and a first motor drive control mechanism that controls the drive of the first motor, The vehicle body includes a second motor that is a drive source for moving the vehicle body along the extension direction of the rope body, and a second motor drive control mechanism that controls the drive of the second motor, 2. The work vehicle according to claim 1, wherein the control unit outputs a first control signal to the first motor drive control mechanism and a second control signal to the second motor drive control mechanism in accordance with at least a position of the first fixed pulley relative to the fixed object and the second fixed pulley.
4. 4. The work vehicle according to claim 3, wherein the control unit performs a first control in which, when the first fixed pulley is provided adjacent to the second fixed pulley, the control unit outputs the second control signal so that the second motor rotates in a first direction to move the vehicle body in a direction toward the fixed object, and at the same time outputs the first control signal so that the rope body is stretched by the reel.
5. 5. The work vehicle according to claim 4, wherein, when the first fixed pulley is provided adjacent to the fixed object, the control unit performs second control by outputting the second control signal so that the second motor rotates in the first direction to move the vehicle body in a direction toward the fixed object when the first control signal is not output.
6. The winding unit further includes a winding amount detection unit that detects information related to the winding amount of the rope body wound by the reel, 6. A work vehicle as described in claim 5, wherein when the first fixed pulley is provided near the midpoint between the fixed object and the second fixed pulley, the control unit determines the amount of winding of the rope body based on information related to the amount of winding of the rope body detected by the winding amount detection unit, and performs either the first control or the second control depending on the amount of winding of the rope body.
7. A computer for controlling the work vehicle according to claim 1, A control method for a work vehicle, which outputs a first control signal to the winding section and a second control signal to the body section based on information related to the amount of winding of the rope body and information related to the amount of movement of the body section, so that the body section moves to a predetermined position.
8. A computer for controlling the work vehicle according to claim 1, A program that outputs a first control signal to the winding unit and a second control signal to the body unit so that the body unit moves to a predetermined position based on information regarding the amount of winding of the rope body and information regarding the amount of movement of the body unit.
Citation Information
Patent Citations
Travel control device for slope work vehicle
JP2015167492A
Work vehicle, work vehicle control method and program
JP7120605B2