The present invention relates to an electrically driven dump truck. In particular, to an electrically driven dump truck which travels by using electric power from trolley wires.
Some types of dump trucks that travel in mines are known as the series hybrid type. Such series hybrid type dump trucks generate electric power with a generator driven by the engine and supply the electric power to rear wheel motors for driving the rear wheels. By taking advantage of the electrical configuration of the series hybrid type, traveling technology based on the trolley system has been implemented. In the trolley-based traveling technology, trolley wires generally employed for electric trains are installed in prescribed climbing sections. In the climbing sections with trolley wires, a vehicle having power collectors (provided on the vehicle to be movable up and down) travels not by using the electric power supplied by the engine and the generator but by using electric power acquired from the trolley wires by elevating sliders of the power collectors to be in contact with the trolley wires (hereinafter referred to as “trolley traveling”). An example of the trolley-based traveling technology has been described in Patent Literature 1, for example. In this case, the drop in the traveling speed in the climbing sections (equipped with the trolley wires enabling the trolley traveling) can be avoided since the electric power supplied from the trolley wires is greater than the electric power generated with the engine power.
Patent Literature 1: U.S. Pat. No. 4,483,148
In the trolley-based traveling technology like the one described in the Patent Literature 1, the driver of the vehicle (dump truck) judges whether or not the vehicle has entered a trolley traveling section. When the vehicle has entered a trolley traveling section and the driver viewing the positional relationship between the sliders and the trolley wires judges that the sliders are capable of contacting the trolley wires, the driver operates a switch (e.g., trolley traveling starting button), by which the trolley traveling is started. During the trolley traveling, the driver visually checks the vehicle's displacement with respect to the trolley wires and performs the steering operation so that central positions of the sliders do not deviate widely from the trolley wires in the lateral direction. The timing for ending the trolley traveling is also judged by the driver; the trolley traveling is ended in response to the driver's pressing a button, for example.
Incidentally, to endure a variety of environments, the trolley wires are made of alloy and a length in design (reference length) has been specified for the trolley wires. If the length of the trolley traveling section is the reference length or less, the trolley traveling section can be covered by use of only one trolley wire, and thus the driver is required only to perform the steering operation so as not to deviate from the one trolley wire. However, in cases where the trolley traveling section is longer than the reference length, two or more trolley wires have to be installed in the vehicle's traveling direction in the trolley traveling section. In this case, a linkage section for an already-existing trolley wire (first trolley wire) and a new trolley wire (second trolley wire) occurs. In the linkage section, the terminating end part of the first trolley wire and the beginning end part of the second trolley wire extend in parallel with each other.
In the operation based on the visual check by the driver in cases where such a linkage section is included in the trolley traveling section, the driver is required not only to perform the steering operation so as to simply prevent each slider's central position from widely deviating from the trolley wire in the lateral direction but also to perform the steering operation so that the trolley wire contacting the slider is shifted from the first trolley wire to the second trolley wire. Such steering operation puts a heavy operating load on the driver.
It is therefore the primary object of the present invention to provide an electrically driven dump truck capable of lightening the operating load on the driver during the trolley traveling and realizing stable trolley traveling even when there exists a trolley wire linkage section.
To achieve the above object, an invention described in claim 1 provides an electrically driven dump truck which travels on a ground including a first traveling section in which at least one first trolley wire is installed, a second traveling section in which at least one second trolley wire is installed, and a trolley wire linkage section in which a terminating end part of the first trolley wire and a beginning end part of the second trolley wire extend in parallel, by use of electric power received from the first trolley wire and the second trolley wire by elevating a slider of a power collector provided on a vehicle to be movable up and down and making the slider successively contact the first trolley wire and the second trolley wire. The electrically driven dump truck comprises: a trolley wire detecting device which is provided on the vehicle and detects the first trolley wire and the second trolley wire from below when the dump truck is traveling; and a control device which executes the following control based on information detected by the trolley wire detecting device:
giving a yaw moment to the vehicle so that the vehicle travels while tracing the first trolley wire before the vehicle reaches the trolley wire linkage section;
stopping the control to give the yaw moment when the vehicle is traveling in the trolley wire linkage section; and
giving a yaw moment to the vehicle so that the vehicle travels while tracing the second trolley wire after the vehicle has passed through the trolley wire linkage section.
In the electrically driven dump truck configured as above, each trolley wire (first trolley wire, second trolley wire) is detected from below with the trolley wire detecting device, and thus there are less factors leading to detection errors compared to conventional techniques detecting lane markers, etc. by capturing images of the ground surface. As a result, the accuracy of the trolley wire detection is improved. Thanks to the improvement of the trolley wire detection accuracy, the control accuracy of the control to give a yaw moment to the vehicle so that the vehicle travels while tracing the first trolley wire and the second trolley wire is improved and the central position of the slider of the traveling vehicle hardly deviates widely from the trolley wire in the lateral direction. Consequently, the operating load on the driver during the trolley traveling can be lightened considerably. Further, along with the tracing of the trolley wire (first trolley wire), whether the vehicle is traveling in the trolley wire linkage section or not is detected. In the trolley wire linkage section, the control is performed not to execute the yaw moment control. With this control, the vehicle is prevented from continuing tracing the first trolley wires and traveling toward the lane edge. After the vehicle has passed through the trolley wire linkage section, the yaw moment control for tracing the trolley wire (second trolley wire) is executed again. Therefore, the trolley wire contacting the slider is shifted from the first trolley wire to the second trolley wire without the need of careful steering operation by the driver. Consequently, trolley wire tracing control in trolley traveling lanes longer than the reference length of one trolley wire becomes possible.
In an invention described in claim 2, in the electrically driven dump truck according to claim 1, when the trolley wire detecting device has detected the first trolley wire, the control device calculates at least one representative point of the vehicle and at least one target point situated on the first trolley wire based on the information detected by the trolley wire detecting device and executes control to give a yaw moment to the vehicle so that the representative point approaches the target point. When the trolley wire detecting device has detected the second trolley wire, the control device calculates at least one representative point of the vehicle and at least one target point situated on the second trolley wire based on the information detected by the trolley wire detecting device and executes control to give a yaw moment to the vehicle so that the representative point approaches the target point.
This control allows the vehicle to travel while tracing the trolley wire when the vehicle is traveling outside the trolley wire linkage section.
In an invention described in claim 3, in the electrically driven dump truck according to claim 1 or 2, the first trolley wire includes two trolley wires: a third trolley wire and a fourth trolley wire. The second trolley wire includes two trolley wires: a fifth trolley wire and a sixth trolley wire. The trolley wire linkage section includes a first trolley wire linkage section in which a terminating end part of the third trolley wire and a beginning end part of the fifth trolley wire extend in parallel and a second trolley wire linkage section in which a terminating end part of the fourth trolley wire and a beginning end part of the sixth trolley wire extend in parallel at a position different from the first trolley wire linkage section. The control device executes the following control based on the information detected by the trolley wire detecting device:
giving a yaw moment to the vehicle so that the vehicle travels while tracing the third trolley wire before the vehicle reaches the first trolley wire linkage section;
stopping the control to give the yaw moment according to the third trolley wire and switching to control to give a yaw moment to the vehicle so that the vehicle travels while tracing the fourth trolley wire when the vehicle has reached the first trolley wire linkage section; and
stopping the control to give the yaw moment according to the fourth trolley wire and switching to control to give a yaw moment to the vehicle so that the vehicle travels while tracing the fifth trolley wire when the vehicle has reached the second trolley wire linkage section.
According to this control, in the first trolley wire linkage section, the control for tracing the third trolley wire is stopped and the yaw moment control is performed so as to trace the fourth trolley wire as a straight section. This allows the vehicle to carry out stable trolley traveling without tracing the deviating third trolley wire. In the second trolley wire linkage section, the control for tracing the fourth trolley wire is stopped and the yaw moment control is performed so as to trace the fifth trolley wire. This makes it possible to control the vehicle so as to have the vehicle trace the fifth trolley wire without tracing the deviating fourth trolley wire. Consequently, stable trolley traveling becomes possible even in cases where the linkage sections of the right and left trolley wires are not at the same position.
In an invention described in claim 4, in the electrically driven dump truck according to any one of claims 1-3, the control device judges that the vehicle is traveling in the trolley wire linkage section when the second trolley wire is detected by the trolley wire detecting device.
This makes it possible to detect whether the vehicle is traveling in the trolley wire linkage section or not with high accuracy, by which the yaw moment control according to the present invention is more stabilized.
In an invention described in claim 5, the electrically driven dump truck according to any one of claims 1-4 further comprises right and left electric motors for traveling. The control device executes both the control to give a yaw moment to the vehicle and traveling speed control by controlling the right and left electric motors.
With this configuration, efficient control, achieving both the deceleration and the generation of the yaw moment at the same time, can be carried out by the control of the electric motors.
In an invention described in claim 6, the electrically driven dump truck according to any one of claims 1-5 further comprises right and left electric motors for traveling and a steering device. The control device includes a vehicle control device, a controller, an inverter control device and a steering control device. The vehicle control device calculates a yaw moment correction value, for the control to give a yaw moment to the vehicle so that the vehicle travels while tracing the first and second trolley wires, based on the information detected by the trolley wire detecting device. The controller controls at least the right and left electric motors or the steering device by using the inverter control device and/or the steering control device based on the yaw moment correction value.
By executing the yaw moment control by using the vehicle control device and the controller as separate components as described above, even when the controller is an already-existing controller, the control in accordance with the present invention can be carried out by just adding the vehicle control device to the controller. The parameters of the yaw moment control can be adjusted just by changing the functions of the vehicle control device. Consequently, high flexibility can be given to the control system.
In an invention described in claim 7, in the electrically driven dump truck according to any one of claims 1-6, the trolley wire detecting device includes: a camera which is provided on the vehicle and continuously captures images of the first and second trolley wires when the dump truck is traveling; and an illuminating device which is provided on the vehicle and illuminates the first and second trolley wires.
Even when a camera is employed for the trolley wire detecting device as above, illuminating the trolley wire with the illuminating device keeps high contrast between the sky and the trolley wire. Consequently, the yaw moment control can be executed with high accuracy not only in the daytime with fine weather but also in conditions in which such high contrast between the sky and the trolley wire is hardly achieved (evening, nighttime, rainy weather, etc.).
According to the present invention, the control accuracy of the control to give a yaw moment to the vehicle so that the vehicle travels while tracing the trolley wire is improved and the central position of the slider of the traveling vehicle hardly deviates widely from the trolley wire in the lateral direction. Consequently, the operating load on the driver during the trolley traveling can be lightened considerably. Further, since the trolley wire contacting the slider is shifted from the first trolley wire to the second trolley wire without the need of careful steering operation by the driver, stable trolley wire tracing control becomes possible even in trolley traveling lanes longer than the reference length of one trolley wire.
Referring now to the drawings, a description will be given in detail of preferred embodiments in accordance with the present invention.
<Configuration of Vehicle—Dump Truck>
In
In
The control device 200 includes an inverter control device 30, an elevation control device 31, a steering control device 32, a vehicle control device 50 and a controller 100. The inverter control device 30 controls the electric motors 6R and 6L according to torque commands inputted thereto. The elevation control device 31 moves the sliders 4Ra and 4La of the power collectors 4R and 4L up and down according to button operations by the driver or inputs from the outside. The steering control device 32 converts the driver's steering operation into an electric signal and thereby controls the steering of the front wheels. The vehicle control device 50 is a characteristic part of the present invention.
The inverter control device 30 includes a torque command calculation unit 30a, a motor control calculation unit 30b and an inverter (switching element) 30c (publicly-known configuration) for each of the right and left electric motors 6R and 6L. The power collectors 4R and 4L are equipped with elevators which move the sliders 4Ra and 4La up and down according to elevation command signals from the elevation control device 31. The details of the power collectors 4R and 4L, the elevation control device 31, the steering system (including the steering control device 32) and the vehicle control device 50 will be described later.
<Basic Operation Including Traveling>
The depressing level P (the degree of depressing) of the accelerator pedal 11 and the depressing level Q of the retarder pedal 12 are inputted to the controller 100 as signals for controlling the magnitude of the driving force and the retarding force (braking force), respectively. For example, when the driver depresses the accelerator pedal 11 to move the dump truck forward or backward, the controller 100 outputs a command regarding a target revolution speed Nr to the engine 21. The command regarding the target revolution speed Nr is outputted based on a preset table of target revolution speeds Nr corresponding to various accelerator angles. The engine 21 is a diesel engine equipped with an electronic governor 21a. Upon receiving the command regarding the target revolution speed Nr, the electronic governor 21a controls the fuel injection quantity so that the engine 21 revolves at the target revolution speed Nr.
The AC generator 22 is connected to the engine 21 to generate AC power. The electric power generated by the AC power generation is rectified by the rectifier circuit 23 and stored in the capacitor 25 (DC voltage: V). A voltage value detected by the sensing resistor 24 (dividing the DC voltage V at a certain ratio) is fed back to the controller 100. The AC generator 22 is controlled by the controller 100 receiving the feedback so that the voltage value equals a prescribed constant voltage V0.
The electric power generated by the AC generator 22 is supplied to the right and left electric motors 6R and 6L via the inverter control device 30. The controller 100 controls the supply of the necessary electric power to the electric motors 6R and 6L by controlling the AC generator 22 so that the DC voltage V acquired by the rectification by the rectifier circuit 23 equals the prescribed constant voltage V0. In contrast, when the sliders 4Ra and 4La of the power collectors 4R and 4L are in contact with the trolley wires 3R and 3L, the DC voltage V0 is directly supplied from the trolley wires 3R and 3L to the inverter control device 30.
The controller 100 calculates torque command values T_MR_a and T_ML_a corresponding to the operation amounts of the accelerator pedal 11 and the retarder pedal 12 and then generates and outputs torque command values T_MR and T_ML for the right and left electric motors 6R and 6L based on the torque command values T_MR_a and T_ML_a, torque correction values T_MR_V and T_ML_V for vehicle speed control, and motor torque correction values T_MR_Y and T_ML_Y for yaw moment control (explained later). The torque command values T_MR and T_ML for the right and left electric motors 6R and 6L and the revolution speeds ωR and ωL of the electric motors 6R and 6L detected by the electromagnetic pickups 16R and 16L are inputted to the inverter control device 30. The inverter control device 30 drives each of the electric motors 6R and 6L via the torque command calculation unit 30a, the motor control calculation unit 30b and the inverter (switching element) 30c.
The right and left rear wheels (tires) 5R and 5L are connected to the electric motors 6R and 6L via the decelerators 7R and 7L, respectively. Each electromagnetic pickup 16R, 16L is generally implemented by a sensor which detects the peripheral speed of a cog of a gear inside the decelerator 7R, 7L. In the drive system for the right-hand side, for example, it is also possible to attach a gear for the detection to a drive shaft inside the electric motor 6R or to a drive shaft connecting the decelerator 7R to the wheel (tire) 5R and arrange the electromagnetic pickup 16R at the position of the gear.
When the driver of the traveling dump truck returns the accelerator pedal 11 and depresses the retarder pedal 12, the controller 100 executes control so that the AC generator 22 does not generate electric power. Further, the torque command values T_MR_a and T_ML_a from the controller 100 turn negative and thus the inverter control device 30 drives the electric motors 6R and 6L to give braking force to the traveling dump truck. In this case, the electric motors 6R and 6L function as generators so as to electrically charge the capacitor 25 by use of the rectification function of the inverter control device 30. The chopper circuit 26 operates to keep the DC voltage value V within a preset DC voltage value V1 while converting electric energy to thermal energy by feeding electric current to the grid resistor 27.
<Upward/Downward Movement of Sliders of Power Collectors>
Next, the elevators for the sliders 4Ra and 4La of the power collectors 4R and 4L will be explained below.
<Steering System>
Next, the steering system will be explained below by referring to
The steering system is made up of the aforementioned steering control device 32 and a steering device 40. The steering device 40 includes a steering wheel 41, a reaction force motor 42 having a steering angle sensor, a steerage motor 43 having a steerage angle sensor, and a rack-and-pinion gear 44.
When the driver operates the steering wheel 41, the steering angle sensor of the reaction force motor 42 detects the operation amount of the steering wheel 41 and sends the detected operation amount to the steering control device 32. The steering control device 32 sends a torque signal to the steerage motor 43 having the steerage angle sensor so that the present steerage angle equals a steerage angle corresponding to the steering angle of the driver. Front wheels 45R and 45L are turned (steerage) by steerage torque which is generated by the steerage motor 43 and transmitted via the rack-and-pinion gear 44. Depending on the magnitude of this torque, reaction force torque is transmitted to the reaction force motor 42 having the steering angle sensor, by which reaction force is transmitted to the steering wheel 41. At the same time, the steering control device 32 sends the steering angle to the controller 100. The steering control device 32 has a function of receiving a steerage torque correction value from the controller 100 and operating the steerage motor 43 (having the steerage angle sensor) according to the received steerage torque correction value. Whether the steering control device 32 similarly sends the reaction force to the reaction force motor 42 having the steering angle sensor or not can be changed properly based on the mode (explained later) at that time and a command from the controller 100. For example, if the steering control device 32 receiving the steerage torque correction value from the controller 100 operates the steerage motor 43 having the steerage angle sensor according to the correction value without sending the reaction force command value to the reaction force motor 42 having the steering angle sensor, the driver loses the steering feeling at that moment even though the vehicle (dump truck) turns according to the steering angle. In contrast, if no command is sent to the steerage motor 43 having the steerage angle sensor even with the steering operation by the driver, the vehicle (dump truck) does not turn in spite of the turning of the steering wheel 41. This means is effective when the controller 100 judges that the steering wheel 41 should not be operated for some reason, for example. As means for informing the driver that the steering wheel 41 should not be operated at the moment, the steering control device 32 may generate torque in a direction opposite to the direction of the driver's steering operation. The torque makes the driver feel that the steering wheel 41 is heavy and recognize that the steering wheel 41 should not be operated in the direction.
While the steer-by-wire system in which the steering wheel 41 is not directly linked to the front wheels 45R and 45L has been explained in this embodiment, the steering system is not limited thereto. For example, an electric power steering system in which the reaction force motor 42 having the steering angle sensor and the steerage motor 43 having the steerage angle sensor are directly connected together as an integral component may also be employed. Further, the steerage motor 43 having the steerage angle sensor may also be implemented by a motor of the hydraulic servo type. Furthermore, the correction value sent from the controller 100 may also be a corrected angle instead of the torque. In this case, the steering control device 32 may be configured to perform torque feedback control so as to eliminate the deviation between the angle detected by the steerage angle sensor and the corrected angle.
<Vehicle Speed Control>
Referring again to
<Yaw Moment Control>
As shown in
<Setting of Yaw Moment Control Mode>
In mines where the dump trucks are traveling, there is an increasing request for the reduction of the time necessary for transporting earth, sand, etc. This is because the reduction of the necessary time shortens the earth/sand transportation cycle of each dump truck and increases the number of times of transportation. The vehicle speed is the major factor directly contributing to the reduction of the necessary time. Therefore, it is desirable to avoid control that causes a decrease in the vehicle speed.
<Combining of Motor Torque Generated by Each Unit>
A method for the calculation of the motor torque command values by the controller 100 will be explained referring to
<Overall Configuration of Characteristic Part>
Next, the overall configuration of the characteristic part of the electrically driven dump truck in accordance with this embodiment will be explained below referring to
As mentioned above, the drive system of the electrically driven dump truck of this embodiment includes the trolley wire detecting device 15 for detecting the trolley wires 3R and 3L and the vehicle control device 50.
The trolley wire detecting device 15 can be implemented typically by a sensor such as a laser radar, a millimeter wave radar or a camera. In an X-Y plane formed by an X-axis representing the traveling direction of the vehicle (direction of the vehicle axis) and a Y-axis representing the lateral direction (perpendicular to the vehicle axis) of the vehicle, any one of the above sensors serves in the present invention as means for detecting the relative positional relationship between the vehicle and the trolley wires. In the case of the laser radar, scanning (searching for the trolley wires) in the X-axis direction of the vehicle is effective for precisely detecting the trolley wires. In the case of the millimeter wave radar, ill effect of the weather (fog, rain, etc.) is lighter in comparison with other types of sensors. These radar sensors are capable of detection not only in the XY directions but also in the Z direction (height direction of the vehicle and the trolley wires). Therefore, the radar sensors can be suitable in cases where the system of the present invention is used together with a system needing the detection in the height direction.
In the case of the camera, images of the trolley wires are shot from below, and thus the trolley wires can be detected precisely in the daytime with fine weather thanks to high contrast between the sky and the trolley wires. It is also possible to equip the vehicle 1 with an illuminating device 51 for illuminating the trolley wires 3R and 3L. In this case, the illumination of the trolley wires 3R and 3L with the illuminating device 51 keeps high contrast between the sky and the trolley wires, by which the trolley wires can be detected precisely even when such high contrast is hardly achieved (evening, nighttime, rainy weather, etc.).
The system may also be constructed by combining two or more sensors.
In this embodiment, the explanation of the detection of the trolley wires will be given of a case where a camera is used as the trolley wire detecting device 15 and the relative positional relationship between the vehicle and the trolley wires in the X-Y plane is detected by performing image processing. Thus, the trolley wire detecting device 15 is implemented by a camera and the trolley wire detection information processing unit 50a is implemented by an image information processing unit which processes the image information captured by the camera 15.
<Camera 15 and Image Information Processing Unit 50a>
The camera 15 captures images of the trolley wires 3R and 3L. In this case where the two trolley wires 3R and 3L are shot by one camera, the camera 15 is desired to be placed at the center of the right and left trolley wires 3R and 3L. It is also possible to shoot each of the right and left trolley wires 3R and 3L respectively with one camera. The image information captured by the camera 15 is sent to the image information processing unit 50a of the vehicle control device 50. The image information represents pixel arrangement in the area shot by the camera 15. The image information processing unit 50a converts the image information into necessary information.
When a strong light source exists in the shooting direction of the camera 15, a whitening and blurring effect called “halation” can occur to the image inputted to the image information processing unit 50a and this can disable the recognition of the target of detection. As a countermeasure against this problem, it is possible to use two cameras: one for shooting the trolley wires 3R and 3L in front of the vehicle and another for shooting the trolley wires 3R and 3L in back of the vehicle. When the image information processing unit 50a judges that the halation has occurred in an image captured by one camera, a correction can be made by use of the other camera. The halation can be detected according to publicly known methods. The two-camera configuration is effective not only when the halation occurs but also when the visual field of one camera is blocked. When the image information processing unit 50a judges that the visual field of one camera is blocked by dirt, mud, etc., a correction can be made similarly by using the other camera. It is also possible to enclose the camera 15 with a housing, make the camera 15 shoot the trolley wires 3R and 3L through glass of the housing, and wash the glass with a wiper, washer fluid, etc. when the image information processing unit 50a judges that the visibility through the glass has been deteriorated by dirt, mud, etc.
When the image information processing unit 50a judges that the amount of ambient light is insufficient for the detection of the trolley wires 3R and 3L (twilight, darkness, etc.), the image information processing unit 50a may output a blink command to the illuminating device 51 to make the illuminating device 51 illuminate the trolley wires 3R and 3L and maintain high contrast between the sky and the trolley wires.
In this embodiment, a case where the dump truck (vehicle) is traveling in a trolley traveling section like the one shown in
As shown in
If each trolley wire 3R, 3L is situated at the center of each slider 4Ra, 4La when the vehicle is traveling straight at the center of the two trolley wires 3R and 3L and in parallel with the trolley wires 3R and 3L, this serves as robustness against deviations (displacement) caused by lateral (right/left) misalignment and vibration (jolting) of the vehicle. Therefore, the vehicle is desired to keep on traveling in such a state.
Further, whether new trolley wires (the second trolley wires 3R2 and 3L2) other than the currently detected trolley wires (the first trolley wires 3R1 and 3L1) are detected in the imaging area a, b, c, d or not is judged.
The image information processing unit 50a sends the coordinate information on the target points and the representative points and information representing whether the second trolley wires 3R2 and 3L2 have been detected or not to the vehicle state quantity calculation unit 50b.
<Vehicle State Quantity Calculation Unit 50b>
The vehicle state quantity calculation unit 50b in this embodiment calculates deviations between the representative points P′, Q′, R′ and S′ and the target points P, Q, R and S. The deviations e_Lad, e_Rad, e_Lbc and e_Rbc between the representative points and the target points are calculated as follows:
e_Lad=M_Lad_Ref−M_Lad_Cont (1)
e_Rad=M_Rad_Ref−M_Rad_Cont (2)
e_Lbc=M_Lbc_Ref−M_Lbc_Cont (3)
e_Rbc=M_Rbc_Ref−M_Rbc_Cont (4)
These deviations take on positive/negative values when the vehicle has shifted leftward/rightward with respect to the trolley wires.
The displacement (deviation) is defined similarly also when the vehicle is traveling obliquely to the trolley wires 3R and 3L as shown in
eθ_L=(e_Lbc−e_Lad)/m (5)
eθ_R=(e_Rbc−e_Rad)/m (6)
When the camera is successfully detecting the right and left trolley wires 3R and 3L as in this embodiment, the expressions (2), (4) and (6) are redundant to the expressions (1), (3) and (5). Therefore, it is desirable to perform the calculation by using information on a successful side (on which the displacement and the inclination can be calculated successfully) when the calculation of the displacement and the inclination is impossible on one side for some reason.
Further, based on the information from the image information processing unit 50a regarding the detection of the second trolley wires 3R2 and 3L2, the vehicle state quantity calculation unit 50b figures out whether the vehicle 1 is traveling in the trolley wire linkage section C or not. Incidentally, the trolley wire linkage section C is the section where the terminating end parts 3R1t and 3L1t of the first trolley wires 3R1 and 3L1 and the beginning end parts 3R2b and 3L2b of the second trolley wires 3R2 and 3L2 extend in parallel.
<Vehicle State Quantity Control Unit 50c>
Next, the vehicle state quantity control unit 50c will be explained below. The vehicle state quantity control unit 50c in this embodiment calculates the yaw moment correction value for making at least one of the representative points coincide with the corresponding target point. First, a process for generating the yaw moment correction value by multiplying the displacement and the inclination represented by the expressions (1)-(6) by gain factors is shown in
As shown in
When information indicating that the vehicle 1 is traveling in the trolley wire linkage section C is inputted, the vehicle state quantity control unit 50c outputs 0 as the yaw moment correction value irrespective of the values of the aforementioned M_Lad_Ref (M_Rad_Ref), M_Lad_Cont (M_Rad_Cont) and eθ_L (eθ_R).
The vehicle state quantity control unit 50c also determines the yaw moment control mode which has been explained referring to
With the configuration and operation described above, the control device 200 (made up of the vehicle control device 50, the controller 100, the inverter control device 30 and the steering control device 32) executes control to give an appropriate yaw moment to the vehicle 1 so that the vehicle 1 travels while tracing the first trolley wires 3R1 and 3L1 or the second trolley wires 3R2 and 3L2 when the vehicle 1 is traveling outside the trolley wire linkage section C. In this case, the control device 200 executes control to give an appropriate yaw moment to the vehicle 1 so that the representative point Z approaches the target point T. Further, the control device executes control to give an appropriate yaw moment to the vehicle 1 so that the inclination eθ_L (eθ_R) decreases. When the vehicle 1 is traveling in the trolley wire linkage section C, the control device 200 executes control so that the yaw moment for tracing the first trolley wires 3R1 and 3L1 or the second trolley wires 3R2 and 3L2 is not outputted.
Besides the simple gain control shown in
<Effect>
According to this embodiment configured as above, the following effects are achieved: Since the trolley wires 3R and 3L are detected from below in this embodiment, there are less factors leading to detection errors compared to the conventional technique detecting lane markers, etc. by capturing images of the ground surface. As a result, the accuracy of the trolley wire detection is improved. Thanks to the improvement of the trolley wire detection accuracy, the control accuracy of the yaw moment control for making the vehicle travel while tracing the trolley wires 3R and 3L is improved and the central position of each slider 4Ra/4La of the traveling vehicle hardly deviates widely from the trolley wire 3R/3L in the lateral direction. Consequently, stable trolley traveling is made possible and the operating load on the driver in the trolley traveling section can be lightened considerably.
Further, along with the tracing of the trolley wires (first trolley wires 3R1 and 3L1), whether the vehicle 1 is traveling in the trolley wire linkage section C or not is detected and the control is performed not to execute the yaw moment control in the trolley wire linkage section C. With this control, the vehicle is prevented from continuing tracing the first trolley wires 3R1 and 3L1 and traveling toward the lane edge 54. After the vehicle has passed through the trolley wire linkage section C, the yaw moment control is executed again to trace the trolley wires (second trolley wires 3R2 and 3L2). Therefore, the trolley wire contacting each slider is shifted from the first trolley wire 3R1/3L1 to the second trolley wire 3R2/3L2 without the need of careful steering operation by the driver. Consequently, stable trolley traveling becomes possible even in cases where the length of the trolley traveling section is greater than the reference length of one trolley wire.
In the case where a camera 15 is used as the trolley wire detecting device, illuminating the trolley wires 3R and 3L with the illuminating device 51 is effective for maintaining high contrast between the sky and the trolley wires 3R and 3L. By use of the illuminating device 51, the yaw moment control for making the vehicle travel while tracing the trolley wires 3R and 3L can be executed with high accuracy not only in the daytime with fine weather but also in conditions in which such high contrast between the sky and the trolley wires 3R and 3L is hardly achieved (evening, nighttime, rainy weather, etc.).
Furthermore, the control device 200 is capable of executing the yaw moment control by using the vehicle control device 50 and the controller 100 as separate components. With this configuration, even when the controller 100 is an already-existing controller, the yaw moment control in accordance with the present invention can be carried out by just adding the vehicle control device 50 to the controller. The parameters of the yaw moment control can be adjusted just by changing the functions of the vehicle control device 50. Consequently, high flexibility can be given to the control system.
<Another Embodiment of Vehicle Control Device 50>
Next, another embodiment of the vehicle control device 50 will be described below.
The main difference between this embodiment and the above embodiment is as follows: In the above embodiment, when the vehicle is not traveling in the trolley wire linkage section C, that is, when the vehicle is traveling in the first traveling section (in which only the first trolley wires 3R1 and 3L1 are installed) or the second traveling section (in which only the second trolley wires 3R2 and 3L2 are installed), only the control to give a yaw moment to the vehicle 1 so that the vehicle 1 travels while tracing the first trolley wires 3R1 and 3L1 or the second trolley wires 3R2 and 3L2 (hereinafter referred to as “trolley wire linkage control and tracing control” as needed) is executed. In this embodiment, elevation control of the slider 4Ra or 4La of the power collector 4R/4L (hereinafter referred to as “slider elevation control” as needed) is executed in addition to the trolley wire linkage control and tracing control. Further, when the trolley wire linkage control and tracing control is executed, a dead zone is set in regard to the deviation between the representative point and the target point. The trolley wire tracing control of the trolley wire linkage control and tracing control is carried out only when the deviation has exceeded the dead zone.
<Image Information Processing Unit 50a>
The processing by the image information processing unit 50a is identical with that in the above embodiment. The image information processing unit 50a sends the coordinate information on the representative points P′, Q′, R′ and S′ and the information on whether the second trolley wires 3R2 and 3L2 have been detected or not to the vehicle state quantity calculation unit 50b.
<Vehicle State Quantity Calculation Unit 50b and Vehicle State Quantity Control Unit 50c>
The vehicle state quantity calculation unit 50b is a component for calculating state quantities to be used for generating control values and command values such as the yaw moment correction value for the trolley wire linkage control and tracing control, the elevation control device elevation command for the elevation control of the slider 4Ra or 4La of the power collectors 4R and 4L, the yaw moment control mode, and the target speed correction value. The vehicle state quantity control unit 50c is a component for generating and outputting the control values and the command values (the yaw moment correction values, the elevation control device elevation command, the yaw moment control mode, the target speed correction value, etc.) based on the result of the calculation by the vehicle state quantity calculation unit 50b.
<Trolley Wire Detecting Area and Coordinate System>
First, a trolley wire detecting area and a coordinate system used by the vehicle state quantity calculation unit 50b will be explained below.
Based on the image information on the imaging area a, b, c, d (see
Further, the vehicle state quantity calculation unit 50b sets a coordinate system having the origin (Op) at the center of the slider 4Ra/4La, the X-axis extending in the traveling direction, and the Y-axis extending leftward with respect to the traveling direction. In the coordinate system, the vehicle state quantity calculation unit 50b sets a representative point at the intersection point Z of the X-axis and the side b1-c1, and sets two target points T and U at the intersection point T of the side b1-c1 and the trolley wire 3R1/3L1 or 3R2/3L2 and at the intersection point U of the side a1-d1 and the trolley wire 3R1/3L1 or 3R2/3L2. Since the camera 15 and the slider 4Ra/4La of the power collector 4R/4L are both attached to the vehicle and the positional relationship between the two components are already known, the coordinates of the intersection points Z, T and U can be determined with ease by means of coordinate transformation, by transforming coordinate values of the points P′, P and R in the coordinate system with the origin Oc shown in
<Trolley Wire Linkage Control and Tracing Control>
First, the vehicle state quantity calculation unit 50b calculates the deviation between the representative point Z and the target point T. Since the Y-coordinate value Y_Cbc of the target point T in front of the slider 4Ra/4La equals the deviation between the representative point Z and the target point T, the vehicle state quantity calculation unit 50b uses the Y-coordinate value Y_Cbc of the target point T as the deviation between the representative point Z and the target point T. The deviation Y_Cbc takes on a positive/negative value when the vehicle has shifted rightward/leftward with respect to the trolley wires.
When the vehicle is traveling obliquely to the trolley wire 3R1/3L1 or 3R2/3L2, similar displacement is defined also in regard to the inclination of the vehicle. In this case, the inclination θ_t of the vehicle with respect to the trolley wire 3R1/3L1 or 3R2/3L2 at a certain time t is represented by the following expression by using the coordinate values of the two target points T and U:
θ_t=(Y_Cbc−Y_Cad)/(X_Cbc−X_Cad) (7)
The vehicle state quantity control unit 50c calculates the yaw moment correction value (for making the representative point Z coincide with the target point T) by using the deviation Y_Cbc between the representative point Z and the target point T or the inclination θ_t of the vehicle.
Further, the vehicle state quantity calculation unit 50b figures out whether the vehicle 1 is traveling in the trolley wire linkage section C or not based on the information from the image information processing unit 50a regarding the detection of the second trolley wires 3R2 and 3L2. The vehicle state quantity control unit 50c outputs 0 as the yaw moment correction value irrespective of the values of the aforementioned deviation Y_Cbc and inclination θ_t when a signal indicating that the vehicle 1 is traveling in the trolley wire linkage section C is inputted.
The other functions of the vehicle state quantity control unit 50c related to the trolley wire tracing control are equivalent to those in the first embodiment.
<Slider Elevation Control>
The vehicle state quantity calculation unit 50b calculates the inclination θ_t of the vehicle at a certain time t. As mentioned above, this inclination θ_t can be calculated according to the above expression (7) by using the coordinate values of the two target points T and U shown in
Further, the vehicle state quantity calculation unit 50b calculates the Y-coordinate Y_p_t of a point W which is defined as the intersection point of the slider 4Ra/4La and the trolley wire 3R1/3L1 or 3R2/3L2.
The Y-coordinate Y_p_t of the point W can be approximated as follows:
Y_p_t=Y_Cbc−θ_t×X_Cbc or
Y_p_t=Y_Cad−θ_t×X_Cad (8)
Here, Y_P_t+1 as the value of Y_p_t one step later (after a time interval Δ) is expressed by using the vehicle speed V as follows:
Y_p_t+1=Y_p_t+V×tan θ_t (9)
Assuming that the permissible range of the Y-coordinate Y_p_t of the point W on the slider 4Ra/4La, within which the slider 4Ra/4La is in contact with the trolley wire 3R1/3L1 or 3R2/3L2 and satisfactory electric power can be acquired continuously, is Y_min (Y-coordinate of a point D)<Y_p_t<Y_max (Y-coordinate of a point C) between points C and D, it can be said that there is no problem with elevating the slider 4Ra/4La in a range satisfying Y_min<Y_p_t+1<Y_max.
At the present time t, the vehicle state quantity calculation unit 50b judges whether or not the Y-coordinate Y_p_t of the point W will be outside the range between Y_min (Y-coordinate of the point D) and Y_max (Y-coordinate of the point C) in the next control step t+1, and outputs the result of the judgment to the vehicle state quantity control unit 50c. If the Y-coordinate Y_p_t of the point W will be outside the range between Y_min (Y-coordinate of the point D) and Y_max (Y-coordinate of the point C), the vehicle state quantity control unit 50c outputs a command signal for lowering the sliders 4Ra and 4La or prohibiting the elevation of the sliders 4Ra and 4La. In contrast, if the Y-coordinate Y_p_t will be within the range, the vehicle state quantity control unit 50c outputs a command signal for elevating the sliders 4Ra and 4La or permitting the elevation of the sliders 4Ra and 4La. The vehicle state quantity control unit 50c may also correct the reaction force of the reaction force motor 42 (see
In this example, the vehicle control device 50 is executing both the trolley wire linkage control and tracing control and the slider elevation control. In the trolley wire linkage control and tracing control, when the vehicle is traveling outside the trolley wire linkage section C, the vehicle state quantity control unit 50c outputs the yaw moment correction value calculated by multiplying the deviation Y_Cbc and the inclination θ_t by the gain factors. Since the outputting of the yaw moment correction value continues until the deviation Y_Cbc and the inclination θ_t become 0, the Y-coordinate Y_p_t of the point W on the slider 4Ra/4La and the inclination θ_t of the vehicle eventually converge on 0 and the vehicle tends to travel while tracing the trolley wire. Also after the passage through the trolley wire linkage section, the control for tracing the second trolley wires 3R2/3L2 is restarted and the yaw moment correction value is outputted so that the deviation Y_Cbc and the inclination θ_t become 0, by which the vehicle 1 is made to trace the second trolley wire 3R2/3L2 in a similar manner.
<Details of Control Process by Vehicle Control Device 50>
Details of a control process executed by the above-described vehicle control device 50 will be explained below referring to a flow chart of
In the first step 200, the image information processing unit 50a captures an image upward from the vehicle 1 with the camera. In step 201, the image information processing unit 50a searches the captured image for the trolley wire 3R or 3L. In the search in the step 201, the whole area of the captured image is searched when the detection of the trolley wire 3R/3L is carried out for the first time. After the trolley wire 3R/3L has been detected once, searching the whole area is unnecessary; searching only a limited area in the vicinity of the coordinates of the already detected trolley wires 3R/3L is effective since it leads to reduction of the search time. In step 202, the image information processing unit 50a judges whether or not there exists an object corresponding to the trolley wire 3R/3L in the captured image. If no object corresponding to the trolley wire 3R/3L is found, the process is finished. If there exists an object corresponding to the trolley wire 3R/3L, the process advances to step 203A. In the step 203A, the image information processing unit 50a executes the edge extraction and the image processing for calculating the center line of the trolley wire 3R/3L.
The process is thereafter handed over to the vehicle state quantity calculation unit 50b. In step 203B, the vehicle state quantity calculation unit 50b sets the aforementioned target points T and U and calculates the coordinates of the target points T and U. Thereafter, the process using the coordinate information on the target points T and U shifts to a trolley wire linkage control and tracing control step 510 for tracing the trolley wire 3R/3L.
<Trolley Wire Linkage Control and Tracing Control>
At the start of the trolley wire linkage control and tracing control step 510, whether an object corresponding to a new trolley wire (the second trolley wire 3R2/3L2), other than the first trolley wire 3R1/3L1 (included in the collectively called “trolley wire 3R/3L”), is detected in the imaging area a, b, c, d or not is judged (step 520). When no new trolley wire 3R2/3L2 is detected, it means that the vehicle 1 is traveling in the first traveling section (not in the trolley wire linkage section), and thus the process advances to step 310 so as to continue the tracing control for tracing the first trolley wire 3R1/3L1. When a new trolley wire is detected in the step 520, it means that the vehicle 1 is traveling in the trolley wire linkage section C. In this case, if the vehicle 1 continues traveling while tracing the already-existing first trolley wire 3R1/3L1, the vehicle 1 is guided to the terminating end part 3R1t/3L1t of the first trolley wire 3R1/3L1 and runs off the lane edge 54. To avoid this problem, the process is ended without outputting the yaw moment for the trolley wire tracing control.
In the trolley wire linkage section C, the vehicle can be considered to be traveling substantially parallel to the trolley wire 3R1/3L1 since the control for tracing the first trolley wire 3R1/3L1 (sufficient control for straight traveling) has been carried out in the previous first traveling section. Therefore, when a new trolley wire (the second trolley wire 3R2/3L2) is detected in the step 520, the vehicle is judged to be traveling in the trolley wire linkage section C and the process is ended without outputting the yaw moment correction value in the section. Since the trolley wire linkage section C is relatively short, the absence of the trolley wire tracing control in the section hardly leads to substantial deviation of the vehicle from the trolley traveling range and the vehicle is prevented from running off the lane edge 54.
Referring again to
As shown in
Here, the reason for setting the yaw moment correction value at 0 between the points A and B shown in
Further, by executing the control so as to increase the yaw moment given to the vehicle 1 with the increase in the absolute value of the deviation Y_Cbc, the vehicle 1 is quickly returned to the center of the sliders 4Ra and 4La when the slider 4Ra/4La of the traveling vehicle is about to widely deviate from the trolley wire 3R/3L in the lateral direction. Consequently, the dump truck can securely be prevented from deviating from the lane with the trolley wires 3R and 3L.
In the next step 330, the yaw moment control mode is selected and outputted. In normal traveling, the mode “1” is selected as the yaw moment control mode since there is no request for reducing the vehicle speed (driver's retarder operation or deceleration by other control).
<Another Example of Trolley Wire Tracing Control in Trolley Wire Linkage Control and Tracing Control>
Control and Tracing Control>
Next, another example of the trolley wire tracing control in the trolley wire linkage control and tracing control will be explained below referring to
As shown in
In
In the next step 323, the target vehicle speed is corrected depending on the position of the target point T.
Next, the yaw moment control mode in the case where the target vehicle speed is corrected to a lower value according to the target vehicle speed correction value shown in
Trolley wires used in ordinary mines include those of positive polarity (a third trolley wire 3R1 included in the first trolley wires and a fifth trolley wire 3R2 included in the second trolley wires) and those of negative (grounded) polarity (a fourth trolley wire 3L1 included in the first trolley wires and a sixth trolley wire 3L2 included in the second trolley wires) as shown in
In such cases, in the first traveling section before the vehicle reaches the first trolley wire linkage section C1, the control is executed by the vehicle state quantity calculation unit 50b and the vehicle state quantity control unit 50c so as to set the representative points T and U on the third trolley wire 3R1 and trace the third trolley wire 3R1 based on the information detected by the image information processing unit 50a. In the first trolley wire linkage section C1, the fourth trolley wire 3L1 captured by the camera is in the ordinary straight state. Therefore, when the vehicle has reached the first trolley wire linkage section C1 and the fifth trolley wire 3R2 has been detected, the control for tracing the third trolley wire 3R1 is stopped and the control is switched so as to trace the fourth trolley wire 3L1. The tracing of the fourth trolley wire 3L1 is continued before the vehicle reaches the second trolley wire linkage section C2. When the vehicle has reached the second trolley wire linkage section C2 and the sixth trolley wire 3L2 has been detected, the control for tracing the fourth trolley wire 3L1 is stopped and the control is switched so as to trace the fifth trolley wire 3R2.
According to this method, in the first trolley wire linkage section C1, the control for tracing the third trolley wire 3R1 is stopped and the yaw moment control is performed so as to trace the fourth trolley wire 3L1 as a straight section. This allows the vehicle to carry out stable trolley traveling without tracing the deviating third trolley wire 3R1. In the second trolley wire linkage section C2, the control for tracing the fourth trolley wire 3L1 is stopped and the yaw moment control is performed so as to trace the fifth trolley wire 3R2. This allows the vehicle to shift to the tracing of the fifth trolley wire 3R2 without tracing the deviating fourth trolley wire 3L1.
In such cases, the use of only one camera for the detection of the two trolley wires 3R and 3L requires an appropriate detection logic for recognizing each of the right and left trolley wires and detecting each of the corresponding new trolley wires. Such a configuration can cause complication of the logic even though the system can be constructed with the minimum number of cameras. Therefore, arranging right and left cameras for the right and left trolley wires 3R and 3L, respectively, and using each camera for individually shooting each trolley wire (so that the processing for detecting the new trolley wire becomes the simplest) is robust in terms of system stability and leads to simplification of the detection logic. Consequently, low-cost system construction is possible depending on the situation.
In the above embodiments, the vehicle traveling in a section like the one shown in
Further, while the outputting of the yaw moment for making the vehicle trace the trolley wire 3L1, 3L2, 3R1, 3R2 is continued in the first and second traveling sections in the explanation of the above embodiments, the control may also be executed so as to perform the calculation of the yaw moment correction value (for making the vehicle trace the trolley wires) and the yaw moment control only in a prescribed traveling section included in the first or second traveling section.
Furthermore, while the camera used as the trolley wire detecting device is pointed directly upward in the above explanation, the camera may also be set to capture images in a forward and upward direction from the vehicle as shown in
Number | Date | Country | Kind |
---|---|---|---|
2011-210752 | Sep 2011 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2012/061985 | 5/10/2012 | WO | 00 | 3/20/2014 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2013/046788 | 4/4/2013 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
3924084 | Lindfors | Dec 1975 | A |
4424875 | Yoshida | Jan 1984 | A |
4483148 | Minami | Nov 1984 | A |
4488234 | Stieber | Dec 1984 | A |
5672947 | Hisada | Sep 1997 | A |
6421600 | Ross | Jul 2002 | B1 |
20090079997 | Watabe | Mar 2009 | A1 |
20090320554 | Watabe | Dec 2009 | A1 |
Number | Date | Country |
---|---|---|
53-6065 | Jan 1978 | JP |
58-179803 | Dec 1983 | JP |
2-272609 | Nov 1990 | JP |
5-278502 | Oct 1993 | JP |
Entry |
---|
International Search Report issued in corresponding application No. PCT/JP2012/061985 on Jun. 12, 2012. |
Number | Date | Country | |
---|---|---|---|
20140224609 A1 | Aug 2014 | US |