Disclosure of Invention
The invention aims to provide a method and a system for deducing grouping and sequencing linkage of a contact network operation vehicle, which can automatically acquire grouping and sequencing linkage information of the contact network operation vehicle, provide parameter basis for anti-collision judgment among vehicles and effectively avoid collision of the contact network operation vehicle in the operation process.
The technical purpose of the invention is realized by the following technical scheme:
a method for deducing grouping and sequencing linkage of an overhead line system working vehicle comprises the following steps:
step one, when the speed of the vehicle is more than v1Meanwhile, speed information and position information of other vehicles are received, and the distance between the other vehicles and the vehicle is smaller than s1And the vehicles with equal speed are judged as the same group to obtain group information;
Step two, receiving the position information of each train in the same marshalling train, sequencing the trains in the same marshalling by the position information of each train to obtain sequencing information, and meeting the condition that the distance between two adjacent trains in each train in the same sequence is less than s2If the distance between a vehicle and its adjacent vehicle in the same sequence is greater than s2Judging in the first step;
and step three, receiving the speed information of each vehicle in the same sequence, and judging the linkage relation among the vehicles according to the positive and negative of the speed to obtain linkage information.
In a further improvement, step T1 is further included between step two and step three: when the vehicle speed is greater than v2When the vehicle passes through the sequence, the longitude and latitude information of the vehicles at two ends in the same sequence is recorded for the first time1Secondly, recording longitude and latitude information of vehicles at two ends in the same sequence;
comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes change and are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes do not change consistently, repeating the step of judging; if the longitude does not change, comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change consistently, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the step; or comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change and are consistent, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the step; if the latitude does not change, comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes are consistent, sequencing the vehicles in the same sequence according to the longitude of the two vehicles at the same moment, and if the longitudes are inconsistent, repeating the judgment of the step.
In each step, the position information is obtained by a GPS collector, and the vehicle speed information is obtained by a wheel diameter pulse collector.
In each step, the calculation method of the distance L between the two vehicles comprises the following steps:
acquiring longitude and latitude of the two vehicles, namely (lat1, lng1) and (lat2, lng 2);
L=(2*sin(sqrt(pow(sin(rad(lat1)-rad(lat2)/2),2)+cos(rad(lat1))*cos(rad(lat2))*pow(sin(rad(lng1)-rad(lng2)/2),2))))*6378137.0;
the vehicle speed information v is calculated by the following method:
obtaining a pulse count value count1, a counting time1, a pulse count value count2 and a countingtime 2; a single pulse distance dis;
v=((count2-count1)*dis)/(time2-time1)。
the invention also provides a system for deducing grouping and sequencing linkage of the contact net operation vehicle, which comprises the following steps:
a grouping module for setting the vehicle speed at a speed greater than v1Meanwhile, speed information and position information of other vehicles are received, and the distance between the other vehicles and the vehicle is smaller than s1And the vehicles with the same speed are judged to be the same marshalling to obtain marshalling information;
the sorting module is used for receiving the position information of each train in the same marshalling train, sorting the trains in the same marshalling by the position information of each train to obtain sorting information, and meeting the condition that the distance between two adjacent trains in each train in the same sequence is less than s2If the distance between a vehicle and its adjacent vehicle in the same sequence is greater than s2Then entering the marshalling module for processing;
and the linkage relation judging module is used for receiving the speed information of each vehicle in the same sequence, judging the linkage relation among the vehicles according to the positive and negative of the speed and obtaining linkage information.
In a further improvement, the sequencing module and the connection relation judging module further comprise a sequence calibration module: for when the vehicle speed is greater than v2When the vehicle passes through the sequence, the longitude and latitude information of the vehicles at two ends in the same sequence is recorded for the first time1Secondly, recording longitude and latitude information of vehicles at two ends in the same sequence;
comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes change and are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes do not change consistently, repeating the judgment of the module; if the longitude does not change, comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change consistently, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the module; or comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change and are consistent, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the module; if the latitude does not change, comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes are inconsistent, repeating the judgment of the module.
In each module, the position information is obtained by a GPS collector, and the speed information is obtained by a wheel diameter pulse collector.
In each module, the calculation method of the distance L between the two vehicles is as follows:
acquiring longitude and latitude of the two vehicles, namely (lat1, lng1) and (lat2, lng 2);
L=(2*sin(sqrt(pow(sin(rad(lat1)-rad(lat2)/2),2)+cos(rad(lat1))*cos(rad(lat2))*pow(sin(rad(lng1)-rad(lng2)/2),2))))*6378137.0;
the vehicle speed information v is calculated by the following method:
obtaining a pulse count value count1, a counting time1, a pulse count value count2 and a countingtime 2; a single pulse distance dis;
v=((count2-count1)*dis)/(time2-time1)。
compared with the prior art, the method and the system for deducing the grouping, sorting and coupling of the contact network operation vehicle can automatically obtain the grouping, sorting and coupling information of the contact network operation vehicle, thereby providing a parameter basis for anti-collision judgment, having high accuracy and efficiency, reducing the labor burden and effectively avoiding manual input errors.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
The present embodiment is only for explaining the present invention, and it is not limited to the present invention, and those skilled in the art can make modifications of the present embodiment without inventive contribution as needed after reading the present specification, but all of them are protected by patent law within the scope of the claims of the present invention.
The operation process of the contact net operation vehicle is as follows:
the first stage is as follows: at least two contact net operation vehicles are driven out of the storehouse in a connected mode and go to an operation place;
and a second stage: the contact net operation vehicle arrives at the operation place, and each contact net operation vehicle independently operates after unhooking, and in the operation process, collision avoidance judgment needs to be carried out.
The method for deriving the grouping, sorting and linking information of the catenary working vehicle provided by the embodiment is applied to the first stage, and the grouping information, the sorting information and the linking information are derived in the process of the first stage, and specifically as follows:
a method for deducing grouping and sequencing linkage of an overhead line system working vehicle comprises the following steps:
step one, when the speed of the vehicle is more than v1In time, receive the speed information of other vehiclesInformation of position, and the distance between the other vehicles and the vehicle is less than s1And the vehicles with equal speed are judged as the same group to obtain group information, v1Preferably 3km/h, s1Preferably 500 m;
step two, receiving the position information of each train in the same marshalling train, sequencing the trains in the same marshalling by the position information of each train to obtain sequencing information, and meeting the condition that the distance between two adjacent trains in each train in the same sequence is less than s2If the distance between a vehicle and its adjacent vehicle in the same sequence is greater than s2Then the judgment of the step one is carried out, the step s2Preferably 50 m;
and step three, receiving the speed information of each vehicle in the same sequence, and judging the linkage relation among the vehicles according to the positive and negative of the speed to obtain linkage information.
Specifically, if four overhead line system operation vehicles exist on the track, wherein the speed of the vehicle is greater than 3km/h, the speed information and the position information of the other three vehicles are received, the vehicles which are less than 500m away from the vehicle and have the same speed are judged to be the same group, and if the other three vehicles all meet the conditions, the vehicles and the vehicle are judged to be the same group, so that the group formation information is obtained; secondly, the vehicle receives the position information of the other three vehicles in the same grouping, the vehicles are sorted according to the position relationship, the vehicles may be sorted into 1, 2, 3, 4 or 4, 3, 2, 1 as the sorting information because no sorting direction exists, and the four sorted vehicles must meet the condition that the distance between the four sorted vehicles and the adjacent vehicle is less than 50m, if the distance between one vehicle and the adjacent vehicle is more than 50m, the vehicle is executed from the beginning in the first step until all the vehicles in the same grouping meet the condition; and after the sorting is finished, performing the third step, and determining the coupling relation between the two adjacent contact net operation vehicles according to the speed direction of each vehicle in the same sequence. It should be noted that: the catenary working vehicle generally has two operation platforms for driving the catenary working vehicle in different directions, and the two ends of the catenary working vehicle are generally divided into an end i and an end ii
Step T1 is also included between the step two and the step three: when the vehicle speed is greater than v2When the vehicle passes through the sequence, the longitude and latitude information of the vehicles at two ends in the same sequence is recorded for the first time1Secondly, recording longitude and latitude information of vehicles at two ends in the same sequence;
comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes change and are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes do not change consistently, repeating the step of judging; if the longitude does not change, comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change consistently, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the step; or comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change and are consistent, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the step; if the latitude does not change, comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes are consistent, sequencing the vehicles in the same sequence according to the longitude of the two vehicles at the same moment, and if the longitudes are inconsistent, repeating the judgment of the step.
The consistent longitude change or the consistent latitude change means that the longitudes or latitudes of the two vehicles become larger or smaller at the same time.
Through the step T1, the order of the vehicles is consistent with the actual vehicle traveling order, which solves the problem that the order information obtained in the step two is uncertain, i.e. the order may be 1, 2, 3, 4, or may be 4, 3, 2, 1, and after the T1, the order can be confirmed to be consistent with the actual traveling direction of the vehicles.
In each of the above steps, the position information is obtained by a GPS collector, and the vehicle speed information is obtained by a wheel diameter pulse collector, as shown in fig. 1, theGPS collector 3 is installed on the roof of the vehicle to collect GPS data, and the wheeldiameter pulse collector 4 is installed on the wheel of the vehicle to perform cumulative calculation of the number of revolutions of the wheel.
In an application example, adisplay 5, an industrialpersonal computer 1 and a datatransmission radio station 2 are further arranged on the overhead line work vehicle, as shown in fig. 1, the datatransmission radio station 2 is mounted on the roof of the vehicle and used for sending information of the vehicle to the outside and receiving information sent by other vehicles, the industrialpersonal computer 1 is mounted on the vehicle body and used for carrying out logic calculation on the information and determining vehicle grouping, sequencing and connection relations, and thedisplay 5 is used for displaying related data information; thedisplay 5,industrial computer 1,data radio 2,GPS collector 3 and wheelfootpath pulse collector 4's relation of connection is shown in fig. 2, utilizesindustrial computer 1 anddata radio 2, and each car can carry out independent judgement, and need not control through always controlling to avoid always controlling and the error risk that takes place signal interruption or delay between each car, limited assurance the stability and the security of operation.
In each step, the calculation method of the distance L between the two vehicles comprises the following steps:
acquiring longitude and latitude of the two vehicles, namely (lat1, lng1) and (lat2, lng 2);
L=(2*sin(sqrt(pow(sin(rad(lat1)-rad(lat2)/2),2)+cos(rad(lat1))*cos(rad(lat2))*pow(sin(rad(lng1)-rad(lng2)/2),2))))*6378137.0;
the vehicle speed information v is calculated by the following method:
obtaining a pulse count value count1, a counting time1, a pulse count value count2 and acounting time 2; a single pulse distance dis;
v=((count2-count1)*dis)/(time2-time1)。
after the marshalling, sequencing and coupling information are obtained, the contact net operation vehicle can perform collision avoidance according to the parameters, and the specific reference is made to the patent application with the application number of 201810049900.3.
The embodiment also provides a system for deducing grouping and sequencing linkage of an overhead line system working vehicle, which comprises:
a marshalling module for inThe speed of the vehicle is greater than v1Meanwhile, speed information and position information of other vehicles are received, and the distance between the other vehicles and the vehicle is smaller than s1And the vehicles with equal speed are judged as the same group to obtain group information, v1Preferably 3km/h, s1Preferably 500 m;
the sorting module is used for receiving the position information of each train in the same marshalling train, sorting the trains in the same marshalling by the position information of each train to obtain sorting information, and meeting the condition that the distance between two adjacent trains in each train in the same sequence is less than s2If the distance between a vehicle and its adjacent vehicle in the same sequence is greater than s2Then entering the grouping module for processing, and the step s2Preferably 50 m;
and the linkage relation judging module is used for receiving the speed information of each vehicle in the same sequence, judging the linkage relation among the vehicles according to the positive and negative of the speed and obtaining linkage information.
The sequencing module and the connection relation judging module further comprise a sequence calibration module: for when the vehicle speed is greater than v2When the vehicle passes through the sequence, the longitude and latitude information of the vehicles at two ends in the same sequence is recorded for the first time1Secondly, recording longitude and latitude information of vehicles at two ends in the same sequence;
comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes change and are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes do not change consistently, repeating the judgment of the module; if the longitude does not change, comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change consistently, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the module; or comparing the latitudes of the two vehicles in the first record and the second record, if the latitudes change and are consistent, sequencing the vehicles in the same sequence according to the latitudes of the two vehicles at the same moment, and if the latitudes change inconsistently, repeating the judgment of the module; if the latitude does not change, comparing the longitudes of the two vehicles in the first record and the second record, if the longitudes are consistent, sequencing the vehicles in the same sequence according to the longitudes of the two vehicles at the same moment, and if the longitudes are inconsistent, repeating the judgment of the module.
In each module, the position information is obtained by a GPS collector, and the vehicle speed information is obtained by a wheel diameter pulse collector.
In each module, the calculation method of the distance L between the two vehicles comprises the following steps:
acquiring longitude and latitude of the two vehicles, namely (lat1, lng1) and (lat2, lng 2);
L=(2*sin(sqrt(pow(sin(rad(lat1)-rad(lat2)/2),2)+cos(rad(lat1))*cos(rad(lat2))*pow(sin(rad(lng1)-rad(lng2)/2),2))))*6378137.0;
the vehicle speed information v is calculated by the following method:
obtaining a pulse count value count1, a counting time1, a pulse count value count2 and acounting time 2; a single pulse distance dis;
v=((count2-count1)*dis)/(time2-time1)。
the foregoing description of the embodiments is provided to facilitate an understanding and use of the invention and it will be apparent to those skilled in the art that various modifications to the embodiments and the generic principles defined herein may be applied to other embodiments without the use of inventive faculty. Therefore, the present invention is not limited to the above embodiments, and those skilled in the art should make improvements and modifications within the scope of the present invention based on the disclosure of the present invention.