Summary of the invention
The object of the present invention is to provide the distributed automatic horizontal control system polling control method of a kind of special vehicle, it does not have centralized microprocessor, automatic leveling control method does not adopt centralized control method, but cooperated automatic leveling by the separate microprocessor of each supporting leg, controls.
The step of the technical solution used in the present invention is as follows:
Step 1) inclination angle collector and each supporting leg controller start, and supporting leg controller, in " leveling preparation " state, is waited for and received data, the default supporting leg number of inclination angle collector transmission Single Chip Microcomputer (SCM) program
non RS485 bus, all supporting leg controllers receive supporting leg number
nand be stored in E
2pROM, then enters in " data wait " state, then enters step 2);
Step 2) telechiric device sends automatic leveling enabled instruction, and actuation means receives wireless remote control signals, sends to inclination angle collector automatic leveling enabled instruction, then enters step 3);
Step 3) inclination angle collector sends enabled instruction on RS485 bus, all supporting leg controllers receive after " leveling starts " instruction, enter " inclination angle wait " state, the timing that simultaneously starts timer is T1, the wait T1 time is not received the inclination data of inclination angle collector, send " inclination angle renewal " instruction, then circular wait obliquity information, then enters step 4);
Step 4) inclination angle collector gathers the current two-dimentional inclination angle value of special vehicle, then sends two-dimentional inclination angle and is worth in RS485 bus, then enters step 5)
The all supporting leg controllers of step 5) receive current two-dimentional inclination angle value, then enter " data wait " state, then enter step 6);
The all supporting leg controllers of step 6) are carried out " level judgement " algorithm, judge whether leveling; If inclination data does not meet leveling condition, enter step 7) step; If inclination data has met leveling condition, enter step 6.1);
Step 6.1) all supporting leg controllers is carried out " minimum angle judgement " algorithm, then enters (6.2);
Step 6.2) minimum angle supporting leg controller is carried out " whether carrying out abnormal leveling judgement " algorithm, then enters 6.3);
Step 6.3), if do not carry out abnormal leveling, minimum angle supporting leg controller sends " leveling success " instruction; If carried out abnormal leveling, minimum angle supporting leg controller sends " leveling completes " instruction, then enters step 6.4);
Step 6.4) all supporting leg controllers enters dormant state, then enters step 6.5);
Step 6.5) inclination angle collector receives after " leveling success " or " leveling completes ", notices actuation means and carries out the demonstration of automatic leveling result;
The all supporting leg controllers of step 7) are carried out " fault judgement " algorithm, judge former primary dip value and work as the poor of top rake value, then enter step 8);
If step 8) change of pitch angle value, whether lower than threshold value, enters step 9); If change of pitch angle value, whether higher than threshold value, enters step 10);
The all supporting leg controllers of step 9) are carried out " normal leveling " algorithm, judge whether minimum altitude supporting leg, if minimum altitude supporting leg controller is carried out supporting leg and stretched action; If not minimum altitude supporting leg controller, attonity, enters " data wait " state, then enters step 11);
The all supporting leg controllers of step 10) are carried out " abnormal leveling " algorithm, judge whether maximum height supporting leg, if maximum height supporting leg controller is carried out supporting leg contracting action; If not maximum height supporting leg controller, attonity, enters " data wait " state, then enters step 11);
After the supporting leg controller action of step 11) action executing supporting leg, send " action completes " instruction to inclination angle collector, then enter reception waiting status;
If step 12) telechiric device sends automatic leveling halt instruction, actuation means receives wireless remote control signals, sends to inclination angle collector automatic leveling halt instruction, then enters step 13);
Step 13) inclination angle collector sends " leveling stops " instruction on RS485 bus, and all supporting leg controllers receive after " leveling stops " instruction, stop all execution algorithms, enter reception waiting status.
Compare with background technology, the beneficial effect that the present invention has is:
1) adopt distributed supporting leg leveling control mode, improved self-leveling reliability.
2) adopt distributed supporting leg leveling control mode, improved the dependence of automatic horizontal control system to supporting leg number.
3) leveling mode is more versatile and flexible, can control supporting leg downlink or uplink.
4) leveling report the test clear and definite, leveling is unsuccessful also can realize time good leveling state automatically, and reports that leveling completes.
Embodiment
Below in conjunction with drawings and Examples, the invention will be further described.
As shown in Figure 1, special vehicle stops on a supporting surface that has a degree of tilt, has 6 supports (support 1, support 2, support 3, support 4, support 5, support 6), support is symmetrically fixed on vehicle gooseneck, and supporting leg controller is installed on each support, and inclination angle collector is housed on vehicle body.
As shown in Figure 1 and Figure 2, the distributed self-level(l)ing device of special vehicle the present invention relates to forms (in Fig. 2, N is 6) by telechiric device, actuation means, inclination angle collector, a N supporting leg controller, a N electric machine controller, a N motor-driven jack.Between the telechiric device the present invention relates to and actuation means, wireless signal is connected; Between actuation means and inclination angle collector, signal is connected; Between inclination angle collector and six supporting leg controllers, RS485 bus is connected, and the RX line of each supporting leg controller is connected with the RX line of inclination angle collector, and the TX line of each supporting leg controller is connected with the TX line of inclination angle collector; Supporting leg controller is connected with electric machine controller signal, and electric machine controller is connected with motor-driven jack signal; The power positive end of inclination angle collector and N supporting leg controller is received the positive pole of special vehicle power supply, and the power supply negative terminal of inclination angle collector and N supporting leg controller is received the negative pole of special vehicle power supply.Because supporting leg controller is mutually independently, duty separately can not influence each other, so the reliability of total system is higher.After supporting leg number changes, supporting leg director demon, without change, only need to change the supporting leg variable of inclination angle collector internal program, so extensibility is also stronger.
As shown in Figure 3, the present invention relates generally to the poll leveling control method between supporting leg controller and inclination angle collector, mainly comprises following steps:
(1) inclination angle collector and each supporting leg controller start.Supporting leg controller, in " leveling preparation " state, is waited for and is received data.Inclination angle collector sends the default supporting leg number of Single Chip Microcomputer (SCM) program
n(N=4 or 6), on RS485 bus, all supporting leg controllers receive supporting leg number
nand be stored in E
2pROM, then enters in " data wait " state.Then enter step (2).
(2) telechiric device sends automatic leveling enabled instruction, and actuation means receives wireless remote control signals, sends to inclination angle collector automatic leveling enabled instruction.Then enter step (3).
(3) inclination angle collector sends enabled instruction on RS485 bus, and all supporting leg controllers receive after " leveling starts " instruction, enter " inclination angle wait " state.Start timer T1, the wait T1 time is not received the inclination data of inclination angle collector simultaneously, sends " inclination angle renewal " instruction, then circular wait obliquity information.Then enter step (4).
(4) inclination angle collector gathers the current two-dimentional inclination angle value of special vehicle, then sends two-dimentional inclination angle and is worth in RS485 bus.Then enter step (5).
(5) all supporting leg controllers receive current two-dimentional inclination angle value, then enter " data wait " state.Then enter step (6).
(6) all supporting leg controllers are carried out " level judgement " algorithm, judge whether leveling.If inclination data does not meet leveling condition, enter step (7); If inclination data has met leveling condition, enter step (6.1).
(6.1) all supporting leg controllers are carried out " minimum angle judgement " algorithm, then enter step (6.2);
(6.2) minimum angle supporting leg controller is carried out " whether carrying out abnormal leveling judgement " algorithm, then enters step (6.3);
(6.3), if do not carry out abnormal leveling, minimum angle supporting leg controller sends " leveling success " instruction; If carried out abnormal leveling, minimum angle supporting leg controller sends " leveling completes " instruction, then enters step (6.4);
(6.4) all supporting leg controllers enter dormant state, then enter step (6.5);
(6.5) inclination angle collector receives after " leveling success " or " leveling completes ", notices actuation means and carries out the demonstration of automatic leveling result.
(7) all supporting leg controllers are carried out " fault judgement " algorithm, judge former primary dip value and work as the poor of top rake value.Then enter step (8).
(8) if change of pitch angle value whether lower than threshold value, enters step (9); If change of pitch angle value whether higher than threshold value, enters step (10).
(9) all supporting leg controllers are carried out " normal leveling " algorithm, judge whether minimum altitude supporting leg, if minimum altitude supporting leg controller is carried out supporting leg and stretched action; If not minimum altitude supporting leg controller, attonity, enters " data wait " state.Then enter step (11).
(10) all supporting leg controllers are carried out " abnormal leveling " algorithm, judge whether maximum height supporting leg, if maximum height supporting leg controller is carried out supporting leg contracting action; If not maximum height supporting leg controller, attonity, enters " data wait " state.Then enter step (11).
(11) after the supporting leg controller action of action executing supporting leg, send " action completes " instruction to inclination angle collector, then enter reception waiting status.
(12) if telechiric device sends automatic leveling halt instruction, actuation means receives wireless remote control signals, sends to inclination angle collector automatic leveling halt instruction.Then enter step (13).
(13) inclination angle collector sends " leveling stops " instruction on RS485 bus, and all supporting leg controllers receive after " leveling stops " instruction, stop all execution algorithms, enter reception waiting status.
Supplementary notes:
(1) as shown in Figure 4, " level judgement " algorithm that supporting leg controller of the present invention is carried out is as follows: when θ x<0.01 degree and two conditions of θ y<0.01 degree meet simultaneously, " level judgement " algorithm judgment result is that leveling; No person, " level judgement " algorithm judgment result is that not leveling;
(2) " fault judgement " algorithm that supporting leg controller of the present invention is carried out is as follows: the two-dimentional inclination data θ x1 that records inclination angle collector gained of last cycle of leveling implementation, the two-dimentional inclination data θ x2 of θ y1 and a rear cycle inclination angle collector gained, θ y2, if when θ x2< θ x1 and these two conditions of θ y2< θ y1 have one to meet, " fault judgement " algorithm judgment result is that not fault; No person, " fault judgement " algorithm judgment result is that and breaks down.
(3) as shown in Figure 4, " minimum angle judgement " algorithm that supporting leg controller of the present invention is carried out is as follows: when θ x>0 degree and two conditions of θ y>0 degree meet simultaneously, " minimum angle judgement " algorithm judgement supporting leg 1 is minimum supporting leg, and supporting leg 4 is the highest supporting leg.
(4) " normal leveling " algorithm that supporting leg controller of the present invention is carried out refers to such an extent that be drive motor forward, carry out supporting leg and stretch action, by progressively increasing a leg length, make two-dimentional inclination data θ x and the θ y of inclination angle collector gained as far as possible little, finally by " level judgement " algorithm, judgment result is that leveling.
(5) " abnormal leveling " algorithm that supporting leg controller of the present invention is carried out refers to such an extent that be drive motor reversion, carry out supporting leg contracting action, by gradually reducing a leg length, make two-dimentional inclination data θ x and the θ y of inclination angle collector gained as far as possible little, finally by " level judgement " algorithm, judgment result is that leveling.
(6) inclination angle collector is responsible for safeguarding timer T2 and T3.If T2 does not receive the data command of any supporting leg controller in the time, send " inclination data " on RS485 bus.If T3 does not receive the data command of any supporting leg controller in the time, send " leveling failure " instruction to actuation means.The timing value of timer T1, T2 and T3 can regulate according to special vehicle counterweight.
(7) in the algorithm of supporting leg controller judgement minimum altitude supporting leg of the present invention and maximum height supporting leg, can select voluntarily control algolithm according to the difference of supporting leg number, support at present supporting leg to count the situation of N=4 or N=6.
(8) what adopt due to RS485 is half-duplex operation mode, so inclination angle collector and all supporting leg controllers are sending instruction or executing after algorithm, enter at once reception waiting status.