Intelligent control system for mountain orchard monorail transport and its control method
The intelligent control system for monorail transport vehicles in mountain orchards stabilizes speed, prevents skidding, recovers energy, and enhances safety through Hall sensors and attitude detection, addressing conventional inefficiencies and safety issues.
Patent Information
- Application Number
- JP2023518926
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2022-07-04
- Filing Date
- 2023-03-03
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Conventional monorail transport vehicles for mountain orchards lack a self-locking function, leading to skidding issues and the inability to recover energy, posing safety concerns and efficiency challenges.
An intelligent control system for monorail transport vehicles equipped with a DC motor, actuator, and non-excitation brake, utilizing Hall sensors and attitude sensors to stabilize speed, prevent skidding, and recover energy during downhill travel, along with automatic parking and load detection.
The system ensures stable speed control, prevents skidding, recovers energy, and facilitates safe and efficient operation in mountainous terrain, reducing impact and improving user experience.
Smart Images

Figure 2024007603000001 
Figure 2024007603000002 
Figure 2024007603000003
Abstract
Description
[Technical field]
[0001] The present invention relates to the technical field of mountain transport vehicle control, and more particularly to an intelligent control system and method for mountain orchard monorail transport vehicle. [Background technology]
[0002] Currently, most of the transportation of agricultural materials in mountain orchards relies on manual labor, which results in low production efficiency, high labor intensity, and difficulty in ensuring production safety. Unmanned transportation equipment, including rail transport vehicles, can adapt to complex terrain environments, have simple structure, high climbing ability, and are safe and easy to use, making them suitable for production work in hilly and mountainous orchards.
[0003] However, conventional gear transmission systems do not have a self-locking function, so when a monorail transport vehicle using a gear transmission is fully loaded, it may become unstable when going up or down a slope. Skid It is prone to the phenomenon of the flywheel and the rook phenomenon, which poses certain safety concerns. At the same time, it does not have an energy recovery function.
[0004] So how to control the speed steadily on the downhill and uphill Skid How to provide an intelligent control system and control method for mountain orchard monorail transport vehicle with detection and energy recovery functions is a problem that those skilled in the art need to solve urgently. Summary of the Invention
[0005] Therefore, the object of the present invention is to Skid The present invention provides an intelligent control system and control method for a mountain orchard monorail transport vehicle, which is capable of detecting the speed of the vehicle and realizing a stable downhill speed control and energy recovery function.
[0006] In order to achieve the above object, the present invention adopts the following technical solutions. A mountain orchard monorail transport intelligent control system, and , transportation track and 、 Control Subsystem and Includes. The transport vehicle includes a DC motor, an actuator, and a non-energized brake. The control subsystem includes a main controller and Skid Detection unit and attitude sensor And include. The above Skid The detection unit includes a first Hall sensor and a first magnet steel. The first magnet steel is uniformly attached to the outer circumference of the rotating shaft of the DC motor. The first Hall sensor is attached directly above the rotating shaft of the DC motor to induce a magnetic field signal of the first magnet steel and detect the actual rotation speed and rotation direction of the DC motor based on the magnetic field signal. The main controller is configured to: Skid Determine whether or not Skidding is occurring In this case, the actuator Non-excitation operation Braking is performed by controlling the brakes. The attitude sensor is for detecting the traveling attitude of the transport vehicle on the transport track. The main controller determines whether the transport vehicle is in an uphill, downhill, or flat section based on the travel posture of the transport vehicle, and applies braking force to the actuator in a different braking mode for each section. Non-excitation operation Brake condition status Control. Furthermore, in the mountain orchard monorail transport vehicle intelligent control system, the control subsystem further includes a motor controller and a lithium battery. The motor controller is for switching the DC motor between a driving mode and a generating mode. When the transport vehicle is traveling downhill and meets the power generation condition, the main controller controls the motor controller via the actuator to switch the operation mode of the DC motor from a driving mode to a power generation mode and recover the generated power in the lithium battery. Furthermore, in the mountain orchard monorail transport vehicle intelligent control system, the control subsystem includes a power generation mode control speed module. The power generation mode control speed module is for, when the DC motor is in a power generation mode and the rotation speed exceeds a safe rotation speed, consuming a portion of the power not recovered by the lithium battery using an energy consumption resistor to maintain the rotation speed within a preset range above and below the safe rotation speed. Furthermore, in the mountain orchard monorail transport vehicle intelligent control system, the control subsystem further includes an automatic parking detection unit. The automatic parking detection unit includes a second Hall sensor and a second magnet steel. The second Hall sensor is mounted on an underside of the head of the transport vehicle. The second magnet steel is provided in two pieces and is attached to the side surfaces of both ends of the transportation track, respectively. The second Hall sensor and the second magnet steel are both located on the same side of the transportation track. The main controller determines whether the magnetic field signal of the second magnet steel detected by the second Hall sensor reaches a threshold value, and when the magnetic field signal reaches the threshold value, controls the actuator to Non-excitation operation Controls braking. In addition, in the mountain orchard monorail transport intelligent control system, the control subsystem further includes a set of control keys, which control the forward, backward and stop of the transport. do is connected to the main controller for In addition, in the mountain orchard monorail transport intelligent control system, the control subsystem further includes a signal receiver and a remote controller, the signal receiver is connected in parallel to each of the sets of control keys, and the remote controller is wirelessly connected to the signal receiver. Furthermore, in the mountain orchard monorail transport intelligent control system, the control subsystem includes a weighing sensor. The weighing sensor is connected to the main controller for measuring the actual payload of the vehicle. The main controller determines whether there is a risk of rollover by combining the traveling attitude of the transport vehicle and the actual load mass, and if there is a risk of rollover, controls the actuator to Non-excitation operation Controls braking. Furthermore, in the mountain orchard monorail transport intelligent control system, the control subsystem includes a sound, light and alarm. The sound light alarm is connected to the main controller. The main controller is for controlling sound and light alert by the sound and light alarm when there is overload, abnormal driving posture.
[0007] The present invention provides a control method for an intelligent control system of a mountain orchard monorail transport vehicle, including a segment braking control method, the control method includes the following steps: S1: The main controller determines whether the transport aircraft is traveling uphill or downhill based on the traveling attitude of the transport aircraft collected by the attitude sensor. If the transport aircraft is traveling uphill, it executes S2. If the transport aircraft is not traveling uphill, it executes S5. S2: The vehicle is on an uphill slope and the main controller triggers the brake signal. No. If detected, The main controller is Run S7. S3: The vehicle is on a downhill slope and the main controller triggers the brake signal. No. If detected, the main controller 、 Turn on the timer and count, detect the motor rotation speed with the first hall sensor, and wait until the timer has completed 500ms count, or 、 The first Hall sensor detects zero reduction in motor speed did If so, execute S7. S4: When the transport is going uphill, but the main controller has not detected the trigger brake signal, The main controller is The actual rotation direction of the motor detected by the first hall sensor and the running direction of the operation command are used to determine the direction of the transport vehicle. SkidDetermine the presence or absence. If the rotation direction of the motor detected by the first Hall sensor does not match the traveling direction of the operation command, The main controller is skidding occurs It is judged that , execute S7. S5: The main controller is Judge whether the transporter is braking on a flat road from the traveling posture of the transporter collected by the posture sensor. If the transporter is braking on a flat road ,Ta Turn on the present and count, and detect the rotation speed of the motor with the first Hall sensor. S6: The main controller is The timer is 1000 ms of Has the count been completed, or 、 The first Hall sensor detects that the decrease in the motor rotation speed is zero did Judge whether it is the case, and if so, execute S7. S7: The main controller operates without excitation. Apply the brake with the brake to stop Let .
[0008] Furthermore, the control method of the mountain orchard monorail transporter intelligent control system includes performing energy recovery when the transporter is on a downhill slope, and includes the following steps. S1': The main controller is The posture of the transporter but Satisfy the horizontal plane inclination angle α>α0 and The actual rotation speed N of the DC motor but Satisfy N0<N<N1 Setting the power generation conditions of the DC motor; and Set the safe rotation speed N2 of the DC motor in the power generation mode To carry out . S2': The main controller is Obtain the posture information of the transporter placed by the posture sensor, and detect the actual rotation speed and rotation direction of the DC motor with the first Hall sensor. S3': The main controller detects the actual rotation speed of the DC motor at S2' and sets it at S1'. Judge whether the power generation conditions are satisfied death, If satisfied, execute S4', if not satisfied, maintain the drive mode of the DC motor. S4': The main controller is 、The actuator controls the motor controller to switch the DC motor's operating mode from drive mode to power generation mode, thereby recovering energy. S5': The main controller is The first Hall sensor detects the rotation speed and direction of the DC motor. S6': The main controller is detected in S5' The actual rotation speed of the DC motor in generating mode is At S1' It is determined whether the set safe rotation speed N2 is exceeded, and if it is exceeded, S7' is executed, and if it is not exceeded, S8' is executed. S7': The main controller is Connect the energy dissipation resistor, The Calculate the magnitude of the output PWM waveform duty cycle required by the main controller, Based on the duty ratio The actual rotation speed of the DC motor is controlled within a preset range above and below the safe rotation speed N2 in the generating mode. S8': The main controller is Determine whether the actual rotation speed of the DC motor in the generating mode is lower than the set DC motor rotation speed N0 in the downhill driving mode, and if so, the main controller controls the motor controller through the actuator to switch the operation mode of the DC motor from the generating mode to the driving mode to power the transport vehicle.
[0009] As can be seen from the above technical solution, the mountain orchard monorail transport intelligent control system and its control method according to the present invention have the following beneficial effects compared with the prior art: 1. The present invention uses an attitude sensor to detect the attitude information of the transport vehicle on the transport track, determines the gradient information, and divides the section into uphill, downhill and flat sections. The main controller controls the gradient information for each section. Non-excitation operation Brakes are applied in stages. When the aircraft is braking uphill, Skid To prevent this, the brakes are Non-excitation operation Brake immediately. When a vehicle brakes on a downhill slope, braking immediately will cause a large shock to the vehicle, and the downhill brakes will cause a large shock to the vehicle. Non-excitation operationDelayed braking can effectively reduce the impact of downhill braking. When the vehicle is braking on a flat road, it can stop the vehicle more smoothly and reduce the impact damage to fruits, etc. Non-excitation operation Braking can be delayed, making smooth parking possible on flat roads. 2. The present invention is to install a bidirectional Hall sensor on the rotating shaft of the motor, and use the bidirectional Hall sensor to collect the running speed and running direction of the transport vehicle in real time, so as to realize the energy recovery when the transport vehicle is going downhill, and Skid It will be possible to accurately determine the presence or absence of a fire, and the transport aircraft will be equipped with energy recovery and Skid It has a preventive function, improving the mileage and safety of transport aircraft. 3. Instead of using mechanically triggered trip switches on both ends, the present invention adopts a non-contact induction method using hall sensors to achieve automatic parking, which greatly reduces the parking caused by weeds and debris in mountain orchards accidentally triggering the trip switch while the vehicle is moving, and improves the user experience. [Brief description of the drawings]
[0010] In order to more clearly explain the technical solutions in the embodiments of the present invention or the prior art, the following will briefly introduce the illustrations used in the description of the embodiments or the prior art. Obviously, the illustrations in the following description are only the embodiments of the present invention, and general technical personnel in this field can obtain other drawings based on the drawings provided without creative labor.
[0011] [Figure 1] The structure diagram of the intelligent control system of the mountain orchard monorail transport vehicle provided by the present invention [Diagram 2] Structural image of the transport aircraft provided by the present invention [Diagram 3] A partial image of the head of the transport vehicle provided by the present invention. [Figure 4] The structural image of the skidding detection unit provided by the present invention. [Diagram 5] Phase image diagram of the first Hall sensor pulse signal provided by the present invention [Figure 6] The structure of the automatic parking detection unit provided by the present invention is shown in FIG. [Figure 7] Hall signal processing circuit diagram provided by the present invention [Figure 8] Signal input / output insulation circuit diagram provided by the present invention [Figure 9] A diagram showing switching between driving mode and power generation mode of a DC motor provided by the present invention. [Figure 10] Speed control principle diagram in power generation mode provided by the present invention [Figure 11] Flowchart of the segment braking control method provided by the present invention [Figure 12] Energy recovery steps and flow chart provided by the present invention [Figure 13] Overall control flow chart of the operation process of the transport aircraft provided by the present invention DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] The following will clearly and completely describe the technical solutions in the embodiments of the present invention in conjunction with the illustrations in the embodiments of the present invention, but it is clear that the described embodiments are only some of the embodiments of the present invention, and are not all of the embodiments. All other embodiments obtained based on the embodiments of the present invention without creative labor by ordinary technical personnel in this field are within the scope of protection of the present invention.
[0013] 1 to 4 show an intelligent control system for mountain orchard monorail transport vehicles according to an embodiment of the present invention. The system includes a transport vehicle 1, a transport track 2, and a control subsystem 3.
[0014] The control subsystem 3 includes a main controller 301 and Skid A detection unit, a posture sensor 302, a DC motor 303, and an actuator 304. Non-excitation operation and a brake 305.
[0015] SkidThe detection unit includes a first Hall sensor 306 and a first magnet steel 307. The first magnet steel 307 is uniformly attached to the outer periphery of the rotating shaft of the DC motor 303, specifically, it can be an array structure consisting of eight round magnet steels, and is uniformly attached to the motor rotating shaft so as to rotate synchronously with the motor rotating shaft. The first Hall sensor 306 is attached directly above the rotating shaft of the DC motor 303. It induces a magnetic field signal of the first magnet steel 307, and detects the actual rotation speed and rotation direction of the DC motor 303 based on the magnetic field signal. The main controller 301 determines whether the actual rotation direction of the DC motor 303 is consistent with the running direction of the operation command. Skid Determine whether or not Sideways skidding is occurring In this case, the actuator 304 Non-excitation operation Braking is performed by controlling the brake 305.
[0016] The attitude sensor 302 is for detecting the traveling attitude of the transportation vehicle 1 on the transportation track. The main controller 301 determines whether the transportation vehicle 1 is traveling on an uphill, downhill, or flat section based on the traveling posture of the transportation vehicle 1, and applies braking force by the actuator 304 in different braking modes for each section. Non-excitation operation Brake 305 situation Control.
[0017] Among them, the main controller 301 adopts an ATMEGA328 single-chip computer. The first Hall sensor 306 adopts a bidirectional Hall sensor. The main controller 301 is connected respectively to the first Hall sensor 306, the attitude sensor 302 and the actuator 304. The actuator 304 is Non-excitation operation It is connected to a brake 305. The actuator 304 is a relay actuator. Non-excitation operation The brake 305 is attached to the tail of the DC motor and is powered by a DC 48V power supply. The main controller 301 controls the brake via the relay actuator 304. Non-excitation operation The brake 305 is controlled to be turned on and off, and a braking torque is applied to the transport 1.
[0018] As shown in Fig. 5, the first Hall sensor 306 outputs two signals, namely, phase A and phase B. When the DC motor 303 rotates in the forward direction, the output pulse signal phase A leads phase B. When the DC motor 303 rotates in the reverse direction, the output pulse signal phase B leads phase A. The main controller 301 calculates the operating speed and running direction of the transport by reading the phase information of the bidirectional Hall sensor, and compares it with the execution signal input by the operation command to execute the operation of the transport. Skid Determine whether or not this has occurred.
[0019] Specifically, the attitude sensor 302 is fixedly attached at a central position inside the head of the transport vehicle 1, and can detect angle information and acceleration information in the X-axis, Y-axis, and Z-axis directions of the transport vehicle 1 in order to determine the traveling attitude of the transport vehicle 1. The attitude information is sent to the main controller 301 via serial communication. The main controller 301 performs segment braking of the road conditions based on the collected X-axis angle information, and performs anti-rollover control of the transport vehicle based on the collected angle information on the Y-axis. The sections are divided according to the detected gradient information into uphill, downhill, and flat sections, and the main controller brakes the transport vehicle in stages based on the different sections. (1) When the transport vehicle is braking on an uphill slope, Skid In order to prevent the occurrence of Non-excitation operation (2) When a vehicle is braking downhill, the vehicle has a certain amount of kinetic energy and gravity, so braking immediately would cause a large impact on the vehicle. Non-excitation operation (3) When the vehicle is braking on a flat road, the vehicle can be stopped smoothly and the impact damage to fruits, etc. can be reduced. Non-excitation operation Braking can be delayed, making smooth parking possible on flat roads.
[0020] Specifically, in this embodiment, as shown in Fig. 2, the transport vehicle 1 includes a head 101, a trailer coupler 102, a transport trailer 103, and a battery box 104. The transport vehicle 1 straddles the transport track 2, and the transport trailer 103 is coupled to the head 101 via the trailer coupler 102 and is dragged or pushed by the head 101.
[0021] In one embodiment, the control subsystem further includes a motor controller 308 and a lithium battery 309. The lithium battery is mounted in the battery box 104. The motor controller 308 is for switching the DC motor 303 between a driving mode and a generating mode. When the transport vehicle 1 is traveling downhill and meets the power generation condition, the main controller 301 controls the motor controller 308 via the actuator 304 to switch the operation mode of the DC motor 303 from the drive mode to the power generation mode, and recovers the generated power in the lithium battery.
[0022] More advantageously, the control subsystem 3 includes a power mode control speed module 310 . The power generation mode control speed module 310 is for consuming a portion of the power not recovered by the lithium battery 309 using an energy consumption resistor when the DC motor 303 is in the power generation mode and the rotation speed exceeds the safe rotation speed, thereby maintaining the rotation speed within a preset range above and below the safe rotation speed.
[0023] As shown in Fig. 9, the main controller 301 adjusts the rotation speed of the DC motor 303 in the driving mode and power generation mode by the method of pulse width modulation, and adjusts the magnitude of the PWM waveform duty ratio output. This realizes the control of the rotation speed in the driving mode of the DC motor 303, and realizes the functions of stepless speed adjustment and downhill stable control speed in the power generation mode. The main controller 301 judges whether the transport 1 is downhill based on the data detected by the first hall sensor 306 and the attitude sensor 302. If the transport 1 is downhill and meets the power generation condition, the motor controller 308 completes the switching of the DC motor 303 from the driving mode to the motor power generation mode by switching the circuit, and the generated energy is recovered by the lithium battery 309.
[0024] When the transport vehicle 1 is in the downhill running power generation mode, the gear transmission does not have a self-locking function, so the component force of gravity acts in the direction of the slope, allowing for acceleration, but the charging efficiency of the lithium battery 309 is limited. A part of the power that cannot be recovered by the power generation mode control speed module 310 is consumed by the consumption energy brake. This ensures a stable control speed in the power generation mode of the downhill DC motor 303, and prevents the occurrence of a flying accident and damage to the lithium battery 309 due to an excessive reverse charging current.
[0025] Specifically, as shown in FIG. 10, when the DC motor 303 is in the power generation mode, the DC motor 303 generates power as a generator, M is the DC motor, Ra is the internal resistor of the armature winding of the motor, La is the armature inductance, and the generator reverse charges the lithium battery in constant current mode. Since gravity continues to work, the gravitational potential energy continues to be converted into kinetic energy, and when the energy recovery of the motor generation reaches the maximum efficiency, the rotation speed of the DC motor continues to increase. In order to protect the lithium battery and prevent the occurrence of a rookie accident, it is necessary to stably control the downhill speed. Switch k is switched to connect the energy consumption resistor Rz to the power generation circuit. The main controller realizes the conduction of the transistor Q1 by adjusting the output magnitude of the PWM waveform duty ratio by the method of pulse width modulation, thereby achieving a stable control speed for the downhill of the transport aircraft in the power generation mode. This circuit design realizes the function of the transport aircraft having energy recovery and stable control speed during downhill running, improving the mileage and safety of the transport.
[0026] In one embodiment, as shown in Fig. 6, the control subsystem 3 includes an automatic parking detection unit. The automatic parking detection unit includes a second Hall sensor 311 and a second magnet steel 312. The second Hall sensor 311 is mounted on the underside of the head 101 of the transporter 1. Two second magnet steels 312 are provided, which are respectively attracted to the side surfaces at both ends of the transport track 2. The second Hall sensor 311 and the second magnet steel 312 are both located on the same side of the transport track 2.
[0027] The main controller 301 judges whether the magnetic field signal of the second magnet steel 312 detected by the second Hall sensor 311 reaches a threshold value, and when the threshold value is reached, the main controller 301 controls the actuator 304 to Non-excitation operation Controls the application of the brake 305.
[0028] When the transport vehicle 1 reaches both ends of the transport track 2, the second Hall sensor 311 attached to the transport vehicle detects the magnetic field signal generated by the second magnet steel 312 and sends a stop signal to the main controller 301, which then controls the self-locking of the corresponding relay actuator 304, Non-excitation operation The brake 305 is applied to stop the vehicle. At this time, the vehicle 1 stops traveling and cannot start traveling in the original direction again. Only the vehicle is allowed to travel in the reverse direction, preventing the vehicle from jumping out of the track at both ends of the track. Instead of the method of installing mechanical triggered travel switches at both ends, a non-contact induction method using a second hall sensor is adopted to realize automatic parking. Parking caused by weeds and debris in mountain orchards accidentally triggering the travel switch while the vehicle is traveling is greatly reduced. The second magnet steel 312 is attached by adsorption to the side of the transport track on any road according to the practical needs of the user, realizing the function of automatic parking on the road and greatly improving the flexibility of the use process of the vehicle.
[0029] Specifically, in this embodiment, the main controller 301 is connected to a signal input, an output separation circuit, and a Hall signal processing circuit.
[0030] Specifically, the Hall signal processing circuit is shown in Figure 7. Hereinafter, the first Hall sensor and the second Hall sensor are collectively referred to as the Hall sensor, and the first magnet steel and the second magnet steel are collectively referred to as the magnet steel. The Hall signal processing circuit is used to amplify the original signal collected by the Hall sensor and convert it into a voltage signal that can be read by a one-chip microcomputer. When the magnet steel triggers the Hall sensor and generates two pulse signals A and B, the A signal is pulled up to 5V through resistor R1 and processed to separate radio waves with different frequencies through capacitor C1. Then, it is connected to the main controller through the output side D2 of the bidirectional inverter U1. The B signal is pulled up to 5V through resistor R4 and processed to separate radio waves with different frequencies through capacitor C3. Then, it is connected to the main controller through the output side D3 of the bidirectional inverter U1. VF is the reference voltage side of the bidirectional inverter U1, and this reference voltage is 2.5V due to the voltage division by resistors R2 and R3, if the voltage input from the Hall sensor is higher than the reference voltage, the bidirectional inverter will output a high level of 5V according to the output side, or conversely, a low level of 0V. The signal collected by the Hall sensor is amplified by the Hall signal processing circuit and processed to separate radio waves of different frequencies, becoming a voltage signal that can be stably read by the one-chip microcomputer.
[0031] As shown in Figure 8, the signal input / output circuit separates the signal input to the main controller from the signal output by the main controller, and plays a role in protecting the main controller. The separation circuit mainly includes photocouplers U2, U4, and inverter U3. When the input signal IN1 is input to a low level, photocoupler U2 pins C and E are conductive, and a low level is input synchronously to the input side of the main controller, playing the role of separating the input signal. The signal output from the output side of the main controller is connected to photocoupler U4 through the inversion action of the inverter, and when the main controller outputs a high level, photocoupler U4 pins C and E are conductive, and a high level is output from the OUT1 output side.
[0032] In another embodiment, the control subsystem further includes a set of control keys 313. The control keys 313 are connected to the main controller 301 for controlling the forward, reverse and stop of the transport 1. Specifically, it includes three sets of normally open jog switches that are fixedly mounted to a control panel on the head 101 of the transport and that manually control forward, reverse, and stop of the transport.
[0033] More advantageously, the control subsystem 3 further includes a signal receiver 314 and a remote controller 315. The signal receiver 314 is connected in parallel to the sets of control keys 313, respectively. The remote controller 315 is wirelessly connected to the signal receiver 314.
[0034] The signal receiver 314 is fixedly mounted inside the transport 1, and a user can wirelessly control the forward movement, backward movement, and stop of the transport 1 remotely via the remote side of the remote controller 315.
[0035] In one embodiment, the control subsystem 3 includes a weighing sensor 316. The weighing sensor 316 is connected to the main controller 301 for measuring the actual load weight of the vehicle 1. The main controller 301 determines whether there is a risk of rollover in combination with the vehicle's driving attitude and the actual load mass, and if there is a risk of rollover, activates the actuator 304 to Non-excitation operation Controls the application of the brake 305.
[0036] The weighing sensors 316 are fixedly attached to the load mechanisms 105 at both the front and rear ends of the transport trailer, respectively, and are used to measure the actual load weight of the transport vehicle and prevent safety concerns caused by overload transportation.
[0037] The transport machine and the transport track are fixed to the track by the engagement of the pressure wheel and the bearing wheel, and run back and forth by dragging or pushing to engage with the head drive wheel. When the loaded load exceeds the maximum device mass, if the load shifts to one side, the mass on both sides along the track of the transport machine becomes asymmetric, causing tilting, and in severe cases, there is a risk of overturning. Therefore, it is necessary to detect the loaded mass with a weighing sensor to prevent overload operation. In addition, if the machine becomes loose after long-term use, the transport machine may overturn. In normal running conditions, the attitude sensor detects that the transport machine is within a certain safe range on the horizontal plane. If operation continues even after the attitude sensor exceeds this safe range, there is a risk of overturning. Non-excitation operation The system will apply brakes to bring the vehicle to a halt, and warn the user to continue driving and take appropriate measures to prevent the vehicle from rolling over.
[0038] More advantageously, the control subsystem 3 includes a sound / light / alarm 317. The sound / light / alarm 317 is connected to the main controller 301. The main controller 301 is for controlling the sound / light / alarm 317 to generate a sound / light alert when there is an excessive load or an abnormal driving posture.
[0039] When an excessive load occurs in the transport vehicle 1 or when the attitude sensor detects an abnormal attitude, the main controller 301 controls the corresponding relay actuator 304 to Non-excitation operation Control the brake 305 to brake the transport aircraft 1 and turn on the sound-light-alarm 317, so that the fault LED flashes and the alarm buzzes, indicating that the system has a problem, so that the staff can handle it in a timely manner.
[0040] In addition, this embodiment provides a control method for a mountain orchard monorail transport intelligent control system, including a segment braking control method. The control method includes the following steps: S1: The main controller determines whether the transport aircraft is traveling uphill or downhill based on the traveling attitude of the transport aircraft collected by the attitude sensor. If the transport aircraft is traveling uphill, it executes S2. If the transport aircraft is not traveling uphill, it executes S5. S2: When the vehicle is going uphill and the main controller detects there is a trigger brake signal, execute S7. S3: When the transport is on a downhill slope and the main controller detects that there is a trigger brake signal, the main controller turns on the 500ms timer to count, detects the motor rotation speed with the first hall sensor, and judges whether the timer completes the 500ms count or the first hall sensor detects the motor rotation speed drop to zero, if yes, execute S7; if not, continue counting and detecting the motor rotation speed. S4: When the transport is on an uphill slope, but the main controller does not detect the trigger brake signal, the actual rotation direction of the motor detected by the first hall sensor and the running direction of the operation command determine the direction of the transport. Skid If the motor rotation direction detected by the first hall sensor does not match the driving direction of the operation command, Skid occurs and S7 is executed. S5: Based on the driving attitude of the transport aircraft collected by the attitude sensor, it is determined whether the transport aircraft is braking on a flat road. If the transport aircraft is braking on a flat road, the main controller turns on the 1000 ms timer to count, and detects the motor rotation speed with the first hall sensor. S6: Determine whether the timer has completed 1000ms counting or the first hall sensor detects the motor rotation speed drop to zero, if so, execute S7; if not, continue counting and detecting the motor rotation speed. S7: Non-excitation operation Apply the brakes to bring the car to a stop.
[0041] Another embodiment of a control method includes energy recovery when the vehicle is downhill and includes the following steps. S1': Set the power generation conditions of the DC motor. The attitude of the transporter satisfies the horizontal plane inclination angle α > α0, and the actual rotation speed N of the DC motor satisfies N0 < N < N1. Set the safe rotation speed N2 of the DC motor in the power generation mode. S2': Use the attitude sensor to obtain the attitude information of the placed transporter, and use the first hall sensor to detect the actual rotation speed and rotation direction of the DC motor. S3': Determine whether the power generation conditions are met. If they are met, execute S4'; if not, maintain the driving mode of the DC motor. S4': The main controller controls the motor controller through the actuator to switch the operating mode of the DC motor from the driving mode to the power generation mode for energy recovery. S5': Detect the rotation speed and rotation direction of the DC motor by the first hall sensor. S6': Determine whether the actual rotation speed of the DC motor in the power generation mode exceeds the set safe rotation speed N2. If it exceeds, execute S7'; if not, execute S8'. S7': Connect the energy consumption resistor, calculate the magnitude of the output PWM waveform duty ratio required by the main controller, and control the actual rotation speed of the DC motor within a preset range above and below the safe rotation speed N2 in the power generation mode. S8': Determine whether the actual rotation speed of the DC motor in the power generation mode is lower than the DC motor rotation speed N0 in the set downhill driving mode. If it is lower, the main controller controls the motor controller through the actuator to switch the operating mode of the DC motor from the power generation mode to the driving mode to supply power to the transporter.
[0042] As shown in FIG. 13, the overall control flow of the operation process of the transporter by the main controller of the present invention is as follows. Initialize the system and turn on serial communication. Read the input signal. Determine whether there is a key press signal. If there is, judge in the order of forward signal, reverse signal, and stop signal. If it is a forward signal, Non-excitation operationRelease the brakes and move the aircraft forward. If the signal is to reverse, Non-excitation operation Release the brakes and reverse the aircraft. If there is a stop signal, Non-excitation operation Apply the brakes and stop the transport moving, if not go back and continue reading the input signals. It judges whether there is an abnormal signal, and if so, the sound, light and alarm will sound. Non-excitation operation The brakes will apply and the transport will stop moving, if not it will go back and continue to read the input signal.
[0043] Each embodiment of the present specification is described recursively, and each embodiment is described by emphasizing the differences from other embodiments, and reference should be made to the common parts between the embodiments. The apparatus disclosed in the embodiment corresponds to the method disclosed in the embodiment, so that the description is simple. Please refer to the method section for related points.
[0044] The above description of the disclosed embodiments enables any person skilled in the art to realize or use the present invention. Various modifications to these embodiments will be apparent to those skilled in the art. The general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Thus, the present invention is not limited to these embodiments shown herein, but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims
1. A mountain orchard monorail transport intelligent control system, a vehicle, a transportation track, and a control subsystem; The transport machine includes a DC motor, an actuator, and a non-excitation operating brake; The control subsystem includes a main controller, a sideslip detection unit, and an attitude sensor; the sideslip detection unit includes a first Hall sensor and a first magnet steel, the first magnet steel is uniformly attached to an outer periphery of a rotating shaft of the DC motor, the first Hall sensor is attached directly above the rotating shaft of the DC motor, induces a magnetic field signal of the first magnet steel, and detects an actual rotation speed and a rotation direction of the DC motor based on the magnetic field signal; The main controller determines whether or not a skid occurs based on whether or not the actual rotation direction of the DC motor coincides with the running direction of the operation command, and when a skid occurs, controls the non-excitation operating brake by the actuator to perform braking; the attitude sensor is for detecting a traveling attitude of the transport vehicle on the transport track, The intelligent control system for mountain orchard monorail transport vehicles is characterized in that the main controller determines whether the transport vehicle is in an uphill, downhill, or flat section based on the driving attitude of the transport vehicle, and controls the state of the non-excited operating brake by the actuator in a different braking mode for each section.
2. the control subsystem further includes a motor controller and a lithium battery; The motor controller is for switching the DC motor between a driving mode and a generating mode. The intelligent control system for mountain orchard monorail transport vehicles as described in claim 1, characterized in that when the transport vehicle meets the power generation condition on a downhill slope, the main controller controls the motor controller through the actuator to switch the operating mode of the DC motor from a driving mode to a power generation mode, and recovers the generated power to the lithium battery.
3. the control subsystem further includes a power mode control speed module; 3. The intelligent control system for mountain orchard monorail transport vehicles according to claim 2, wherein the power generation mode control speed module is configured to, when the DC motor is in the power generation mode and the rotation speed exceeds a safe rotation speed, consume a portion of the power not recovered by the lithium battery using an energy consumption resistor to maintain the rotation speed within a preset range above and below the safe rotation speed.
4. The control subsystem further includes an automatic parking detection unit; The automatic parking detection unit includes a second Hall sensor and a second magnet steel; The second Hall sensor is mounted on an underside of a head of the transport vehicle; The second magnet steel is provided in two pieces, and is attached to the side surfaces of both ends of the transportation track, respectively; the second Hall sensor and the second magnet steel are both located on the same side of the transportation track; The intelligent control system for mountain orchard monorail transport vehicles of claim 1, characterized in that the main controller determines whether the magnetic field signal of the second magnet steel detected by the second Hall sensor reaches a threshold value, and when the threshold value is reached, controls the braking of the non-excited operating brake by the actuator.
5. the control subsystem further includes a plurality of sets of control keys; The mountain orchard monorail transport vehicle intelligent control system as claimed in claim 1, characterized in that the control keys are connected to the main controller for controlling the forward, reverse and stop of the transport vehicle.
6. The intelligent control system for mountain orchard monorail transport vehicles as described in claim 5, characterized in that the control subsystem further includes a signal receiver and a remote controller, the signal receiver is connected in parallel to a plurality of sets of the control keys respectively, and the remote controller is wirelessly connected to the signal receiver.
7. the control subsystem includes a weighing sensor; the weighing sensor is connected to the main controller for measuring an actual payload of the vehicle; The intelligent control system for mountain orchard monorail transport vehicles of claim 1, characterized in that the main controller determines whether there is a risk of rollover by combining the running attitude of the transport vehicle and the actual load mass, and controls the braking of the non-excited operating brake by the actuator if there is a risk of rollover.
8. the control subsystem includes a sound, light, and alarm; The sound / light / alarm is connected to the main controller; The intelligent control system for mountain orchard monorail transport vehicles as described in claim 1, characterized in that the main controller is for controlling the sound and light alarm to issue a sound and light alert when there is an excessive load or abnormal driving posture.
9. A control method for a mountain orchard monorail transport vehicle intelligent control system, including a segment braking control method, characterized in that the control method for a mountain orchard monorail transport vehicle intelligent control system includes the following steps. S1: The main controller determines whether the transport aircraft is traveling uphill or downhill based on the traveling attitude of the transport aircraft collected by the attitude sensor, and if the transport aircraft is traveling uphill, executes S2, and if the transport aircraft is not traveling uphill, executes S5. S2: If the vehicle is on an uphill slope and the main controller detects a trigger brake signal, the main controller executes S7. S3: When the transport is on a downhill slope and the main controller detects a trigger brake signal, the main controller turns on the timer to count, detects the motor rotation speed with the first hall sensor, and judges whether the timer has completed counting 500 ms or the first hall sensor detects the motor rotation speed decreasing to zero, and if so, executes S7. S4: When the vehicle is on an uphill slope but the main controller does not detect the trigger brake signal, the main controller judges whether the vehicle is skidding from the actual rotation direction of the motor detected by the first hall sensor and the running direction of the operation command. If the rotation direction of the motor detected by the first hall sensor does not match the running direction of the operation command, the main controller judges that skidding has occurred and executes S7. S5: The main controller determines whether the transport vehicle is braking on a flat road based on the driving attitude of the transport vehicle collected by the attitude sensor, and if the transport vehicle is braking on a flat road, turns on the timer to count and detects the motor rotation speed with the first hall sensor. S6: The main controller judges whether the timer has completed counting 1000 ms or the first hall sensor has detected the motor rotation speed decreasing to zero, and if so, executes S7. S7: The main controller applies the brakes with the non-excitation brakes to stop the vehicle.
10. 10. The control method for a mountain orchard monorail transport intelligent control system as claimed in claim 9, further comprising: performing energy recovery when the transport is downhill, comprising the steps of: S1': The main controller sets the power generation conditions of the DC motor such that the attitude of the transport aircraft satisfies the horizontal plane tilt angle α>α0 and the actual rotation speed N of the DC motor satisfies N0<N<N1, and sets a safe rotation speed N2 of the DC motor in the power generation mode. S2': The main controller obtains the attitude information of the transportation vehicle using the attitude sensor, and detects the actual rotation speed and rotation direction of the DC motor using the first Hall sensor. S3': The main controller judges whether the actual rotation speed of the DC motor detected in S2' satisfies the power generation condition set in S1'. If it does, it executes S4'. If it does not, it maintains the drive mode of the DC motor. S4': The main controller controls the motor controller by the actuator to switch the operation mode of the DC motor from the drive mode to the power generation mode, and recovers energy. S5': The main controller detects the rotation speed and direction of the DC motor using the first hall sensor. S6': The main controller determines whether or not the actual rotation speed of the DC motor in the power generation mode detected in S5' exceeds the safe rotation speed N2 set in S1'. If it exceeds the safe rotation speed N2, the process executes S7'. If it does not exceed the safe rotation speed N2, the process executes S8'. S7': The main controller connects the energy consumption resistor, calculates the magnitude of the output PWM waveform duty ratio required by the main controller, and controls the actual rotation speed of the DC motor based on the duty ratio to be within a preset range above and below the safe rotation speed N2 in the power generation mode. S8': The main controller judges whether the actual rotation speed of the DC motor in the generating mode is lower than the set DC motor rotation speed N0 in the downhill driving mode, and if so, the main controller controls the motor controller via the actuator to switch the operation mode of the DC motor from the generating mode to the driving mode to power the vehicle.
