CN113581198A - Unmanned mine car parking control method based on parking control point - Google Patents

Unmanned mine car parking control method based on parking control point Download PDF

Info

Publication number
CN113581198A
CN113581198A CN202110705541.4A CN202110705541A CN113581198A CN 113581198 A CN113581198 A CN 113581198A CN 202110705541 A CN202110705541 A CN 202110705541A CN 113581198 A CN113581198 A CN 113581198A
Authority
CN
China
Prior art keywords
point
excavator
parking
positioning
mine car
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110705541.4A
Other languages
Chinese (zh)
Other versions
CN113581198B (en
Inventor
熊焱飞
潘伟
李泉
秦晓驹
陆盼
杨浩
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Anhui Haibo Intelligent Technology Co ltd
Original Assignee
Anhui Haibo Intelligent Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Anhui Haibo Intelligent Technology Co ltd filed Critical Anhui Haibo Intelligent Technology Co ltd
Priority to CN202110705541.4A priority Critical patent/CN113581198B/en
Publication of CN113581198A publication Critical patent/CN113581198A/en
Application granted granted Critical
Publication of CN113581198B publication Critical patent/CN113581198B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/06Automatic manoeuvring for parking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18036Reversing
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Operation Control Of Excavators (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a parking control method of an unmanned mine car based on a parking control point, which comprises the following specific steps of obtaining road information of a mine and positioning information of a digging machine; determining a turning control point of the mine car and the closest point of the main road of the excavator according to the positioning information of the excavator; determining the intersection point and the return intersection point of the mine car by using the obtained closest point of the main road of the excavator; and simultaneously determining a reversing control point of the mine car according to the turning control point and the mine car joint point. According to the invention, the mine car is accurately guided by acquiring the road information of the mine and the positioning point information of the excavator and selecting different control points with different functions in the process of the parking path of the mine car, so that the mine car can be controlled to be more accurately stopped at the charging point when parking, the problems that the parking failure caused by the fact that the mine digging point is gradually far away from the trunk road is not ensured due to the fact that the parking distance is increased and the parking failure caused by the obstacle in the process of parking can be solved, and the success rate of parking and the overall parking efficiency are improved.

Description

Unmanned mine car parking control method based on parking control point
Technical Field
The invention relates to the technical field of unmanned mine cars, in particular to a parking control method of an unmanned mine car based on a parking control point.
Background
At present, unmanned mine car all drives the machine setpoint through backing a car directly at the intersection point in the charging process of parking in the mine, and a plurality of problems can appear in this kind of mode of parking, if: along with the continuous operation of the excavator, the excavation point is farther and farther from the main road, and the backing speed is very slow, so that the whole loading and parking efficiency is influenced; in addition, a connecting line between the intersection point and the positioning point of the excavator is not in the direction of the excavator, and although no barrier exists in the direction of the excavator, the obstacle can not be guaranteed to be met during reversing the automobile, so that parking failure is caused, and the inaccurate parking can be caused when the reversing distance is too long.
Disclosure of Invention
The invention aims to overcome the defects of the prior art, and in order to realize the aim, the invention adopts the parking control point-based unmanned mine car parking control method to solve the problems in the background technology.
A parking control method of an unmanned tramcar based on a parking control point comprises the following steps:
acquiring road information of a mine and positioning information of an excavator;
determining a turning control point of the mine car and the closest point of the main road of the excavator according to the positioning information of the excavator;
determining the intersection point and the return intersection point of the mine car by using the obtained closest point of the main road of the excavator;
and simultaneously determining a reversing control point of the mine car according to the turning control point and the mine car joint point.
As a further aspect of the invention: the specific steps of determining the turning control point of the mine car according to the digging machine positioning information comprise:
firstly, acquiring positioning point coordinates of digging positioning information and a digging machine orientation angle;
calculating the coordinates of the turning control points according to the coordinates of the positioning points and the heading angle of the excavator;
the coordinate calculation formula is as follows:
Figure BDA0003131054640000011
and (X, y and theta) are positioning information of the excavator, L is n + d + X is the reversing distance, n + d is the distance of n parking spaces d, and X is the length of the shovel arm of the excavator.
As a further aspect of the invention: the specific step of determining the closest point of the main road of the excavator according to the excavator positioning information comprises the following steps:
acquiring preset road information of a mine, and acquiring positioning information of a current excavator, wherein the positioning information comprises longitude and latitude of the excavator and orientation angle information of a shovel arm;
calculating the distance from each point of the main road to the positioning point according to each point of the main road of the road information and the positioning point of the excavator;
taking the point with the closest distance from each point of the main road to the positioning point as the closest point of the main road of the excavator;
the closest point distance calculation formula is as follows:
Figure BDA0003131054640000021
wherein (x, y) is the positioning point coordinate of the excavator, (x)i,yi) Is the ith point coordinate of the main road.
As a further aspect of the invention: the specific steps of determining the intersection point and the return trip intersection point of the mine car by using the obtained closest point of the main road of the excavator comprise:
obtaining the closest point of a main road of the excavator and the current heading angle of the excavator;
judging whether an outward directed line segment of the direction of the excavator has an intersection point with the main road or not according to the current excavator direction angle;
if the intersection point exists, the position which takes the intersection point as a starting point and backs for a preset distance S is taken as an intersection point;
if no intersection point exists, the position with the closest point as a starting point and the preset distance S is backed off as an intersection point;
meanwhile, the position advanced by the preset distance S' by taking the closest point as a starting point is taken as a return trip intersection point.
As a further aspect of the invention: the concrete steps of determining the reversing control point of the mine car according to the turning control point and the mine car intersection point comprise:
obtaining a turning control point and an excavator positioning point;
taking the turning control point as a plumb foot to serve as a vertical line of a line segment from the turning control point to the positioning point of the excavator;
then according to the foot drop, the preset distance S is setCBObtaining two points B1 and B2 on the vertical line as reversing control points;
the calculation formula of the reversing control point is as follows:
Figure BDA0003131054640000031
in the formula (x)C,yC) Is the coordinate of the turning control point, and theta is the angle number;
judging whether an angle between the turning control point as a vertex and an intersection point and a reversing control point as two sides is an obtuse angle or not;
if the angle is acute, the angle is obtuse, the final reversing control point is determined.
Compared with the prior art, the invention has the following technical effects:
by adopting the technical scheme, the longitude and latitude and the shovel arm orientation angle of the excavator are acquired by utilizing the positioning information acquisition equipment arranged on the excavator. And then acquiring the road information of the main road of the global path of the mine. The closest point and the turning control point of the main road of the excavator can be determined through calculation according to the longitude and latitude of the excavator and the orientation angle of the shovel arm, the intersection point and the return intersection point of parking are determined through the closest point, and the reversing control point can be obtained according to the turning control point and the intersection point. And then according to the control points, completing the parking and loading process of the mine car in the loading area, such as entering, turning, backing and returning. Therefore, the problem that the existing car backing distance is increased due to the fact that the mine digging point is gradually far away from the main road, and the car backing failure caused by the fact that obstacles exist in the car backing process can not be guaranteed is solved, and the success rate of parking and the overall parking efficiency are improved.
Drawings
The following detailed description of embodiments of the invention refers to the accompanying drawings in which:
FIG. 1 is a schematic illustration of steps of a method of controlling parking of an unmanned mining vehicle according to some embodiments disclosed herein;
FIG. 2 is a schematic illustration of a shovel and a trunk having an intersection according to some embodiments of the present disclosure;
FIG. 3 is a schematic illustration of a excavator and a trunk without an intersection according to some embodiments disclosed herein;
fig. 4 is a schematic diagram of a selection of reverse control points according to some embodiments disclosed herein.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The driving process of the unmanned mine car is divided into two stages, wherein the first stage is to track the unmanned mine car from a discharge point under a mountain to a mine charging area along a trunk road, the second stage is to find a proper junction point on the mine, the tracking control of the unmanned mine car is handed to a loading parking control (ALP) for path planning, and a plurality of reasonable temporary control points are designed in the path planning process to guide the mine car to simulate manual driving and finally reach the charging point.
Meanwhile, inertial navigation receiving equipment is arranged at the rotation center of the shovel arm of the excavator and used for acquiring longitude and latitude information of the current excavator and the orientation angle of the shovel arm. And recording the longitude and latitude and orientation angle information of the current position, and feeding back the information to the card adjusting platform.
Referring to fig. 1, in an embodiment of the present invention, a parking control method for an unmanned mining vehicle based on a parking control point includes:
firstly, a card adjusting platform issues longitude and latitude and orientation angle information of the current position of an excavator to an unmanned mine car through a 4G gateway, an MDC (media data center) computing platform on the unmanned mine car receives the longitude and latitude and orientation angle information of the current position of the excavator, and then combines with road information recorded in advance to compute control points which are required to pass by when the position of the mine car reaches a shovel loading position, wherein the control points comprise an intersection point A, a turning control point C, a backing control point B, a closest point E of the excavator to a main trunk road, an excavator positioning point D and a return intersection point F; the sequence of the mine car reaching each control point is as follows: firstly, the vehicle runs from the junction A to the turning control point C in the forward direction, then the vehicle speed is reduced to run to the reversing control point B, the vehicle is stopped at the point B, the reverse gear is hung, the vehicle runs to the charging point D in the reverse direction, the vehicle runs to the junction F at the downhill after the charging is finished, and finally the whole charging process is finished by tracking the downhill.
S1, acquiring road information of the mine and positioning information of the excavator;
s2, determining a turning control point of the mine car and the nearest point of the main road of the excavator according to the excavator positioning information;
the concrete steps of calculating and selecting the turning control point comprise:
firstly, acquiring positioning point coordinates of digging positioning information and a digging machine orientation angle;
calculating the coordinates of the turning control points according to the coordinates of the positioning points and the heading angle of the excavator;
the coordinate calculation formula is as follows:
Figure BDA0003131054640000041
and (X, y and theta) are positioning information of the excavator, L is n + d + X is the reversing distance, n + d is the distance of n parking spaces d, and X is the length of the shovel arm of the excavator.
In a particular embodiment, as shown in figure 2, at the point of the excavator which is pushed outwards upwards by L1 m, where L1 is taken to be 40m, at the D point reference point. The manual driving reversing distance is approximately the distance of n parking spaces, according to the actual situation, n is 3, each parking space is approximately about 10m, in addition, the arm length X m of the excavator needs to be considered in automatic driving, the current model is that the arm length is 10m in PC2000 excavating, therefore, the similar reversing distance can be set to be L1 n d + X in automatic driving, and the reversing distances corresponding to excavating machines of other model sizes can be obtained by analogy. And substituting the coordinates into the coordinate formula to obtain the coordinates of the turning control point.
The specific steps of calculating and selecting the closest point of the main road of the excavator comprise:
acquiring preset road information of a mine, and acquiring positioning information of a current excavator, wherein the positioning information comprises longitude and latitude of the excavator and orientation angle information of a shovel arm;
calculating the distance from each point of the main road to the positioning point according to each point of the main road of the road information and the positioning point of the excavator;
taking the point with the closest distance from each point of the main road to the positioning point as the closest point of the main road of the excavator;
the closest point distance calculation formula is as follows:
Figure BDA0003131054640000051
wherein (x, y) is the positioning point coordinate of the excavator, (x)i,yi) Is the ith point coordinate of the main road.
In the specific implementation mode, the longitude and latitude information of a positioning point D of the excavator is known, the longitude and latitude information of each point on the main road is known, and the D point (x, y) and each point (x) on the main road can be calculated through a distance formula between the two pointsi,yi) And (4) selecting the point with the minimum numerical value, namely the point with the shortest distance, and obtaining the closest point E.
S3, determining the intersection point and the return intersection point of the mine car by using the obtained closest point of the main road of the excavator; the method comprises the following specific steps:
obtaining the closest point of a main road of the excavator and the current heading angle of the excavator;
judging whether an outward directed line segment of the direction of the excavator has an intersection point with the main road or not according to the current excavator direction angle;
if the intersection point exists, the position which takes the intersection point as a starting point and backs for a preset distance S is taken as an intersection point;
if no intersection point exists, the position with the closest point as a starting point and the preset distance S is backed off as an intersection point;
meanwhile, the position advanced by the preset distance S' by taking the closest point as a starting point is taken as a return trip intersection point.
In the specific embodiment, as shown in fig. 2 and 3, fig. 1 shows a case where the excavator faces the main road at an intersection, and fig. 2 shows a case where the excavator faces the main road at no intersection. And (4) judging whether an intersection point exists between the directed line segment and the trunk road, wherein the directed line segment extends upwards and outwards for a certain distance according to the direction of the excavator. Specifically, two situations can be distinguished:
there is an intersection with the trunk: the intersection point is P, and in order to ensure that the point B is on the right side of the shovel arm of the excavator, the point ≤ ACB needs to be obtuse angle, and then the point P is taken as a starting point to retreat (i.e. the vehicle reversing direction) Sm, and S takes a point of 50m as the intersection point A according to actual conditions.
No intersection with the trunk road: as the excavator is continuously deep in operation, the excavator is far away from the main road, the directed line segment possibly has no intersection with the main road, and then the directed line segment moves backwards (namely the reversing direction of the vehicle) Sm by taking the closest point E as a starting point, wherein S selects a point of 50m as an intersection point A according to actual conditions.
Meanwhile, returning to the trunk road for return trip handover after charging is completed, specifically, according to the closest point E of the trunk road when going downhill, the method is the same as the method for going uphill, and collision between vehicles going downhill and downhill is avoided. And the position which is advanced by a preset distance S 'by taking the closest point as a starting point is taken as a return trip intersection point, wherein S' can be selected to be 60m according to the actual situation.
And S4, determining the reverse control point of the mine car according to the turning control point and the mine car joint point. The method comprises the following specific steps:
obtaining a turning control point and an excavator positioning point;
taking the turning control point as a plumb foot to serve as a vertical line of a line segment from the turning control point to the positioning point of the excavator;
then according to the foot drop, the preset distance S is setCBObtaining two points B1 and B2 on the vertical line as reversing control points;
the calculation formula of the reversing control point is as follows:
Figure BDA0003131054640000061
in the formula (x)C,yC) Is the coordinate of the turning control point, and theta is the angle number;
judging whether an angle between the turning control point as a vertex and an intersection point and a reversing control point as two sides is an obtuse angle or not;
if the angle is acute, the angle is obtuse, the final reversing control point is determined.
In the embodiment, a vertical line of a straight line DC is drawn at a turning control point C, points B1 and B2 are respectively selected at the left end and the right end of the vertical line, and the lengths of CB1 and CB2 are taken as SCBm, which may be actually scaled to 12m, may be modified as appropriate, wherein the reverse control point B selects to reverse at point B1 or at point B2 according to the position of the intersection point a on the main road, such as reverse points B1 or B2 shown in fig. 4, and in order to simulate the habit of manual driving, in general, if the excavator is on the left side of the main road, the excavator is selected to reverse at the right side point of the main road, and the excavator is on the right side of the main road, the excavator is selected to reverse at the left side point of the excavator. Along with the difference of the position of an intersection point A, the angle ACB can be an obtuse angle and also can be an acute angle, when the angle ACB is specified to be an obtuse angle, a blunt angular point B is taken as a reversing point, in order to ensure that the angle ACB is an obtuse angle when the point B is on the right side of the excavator, A should be on the left side of the intersection point P of the excavator towards the main road, B1, and the calculation process of the point B2 is as follows:
Figure BDA0003131054640000071
and (3) using the included angle ACB of AC and CB as a cosine theorem, and if the included angle ACB is abandoned in an acute angle and is an obtuse angle, selecting the side point as a reversing control point B point.
Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that changes, modifications, substitutions and alterations can be made in these embodiments without departing from the principles and spirit of the invention, the scope of which is defined in the appended claims and their equivalents, which should be construed as being within the scope of the invention.

Claims (5)

1. A parking control method of an unmanned mine car based on a parking control point is characterized by comprising the following specific steps:
acquiring road information of a mine and positioning information of an excavator;
determining a turning control point of the mine car and the closest point of the main road of the excavator according to the positioning information of the excavator;
determining the intersection point and the return intersection point of the mine car by using the obtained closest point of the main road of the excavator;
and simultaneously determining a reversing control point of the mine car according to the turning control point and the mine car joint point.
2. The method for controlling parking of an unmanned mining vehicle based on a parking control point of claim 1, wherein the step of determining a turning control point of the mining vehicle based on the excavator positioning information comprises:
firstly, acquiring positioning point coordinates of digging positioning information and a digging machine orientation angle;
calculating the coordinates of the turning control points according to the coordinates of the positioning points and the heading angle of the excavator;
the coordinate calculation formula is as follows:
Figure FDA0003131054630000011
and (X, y and theta) are positioning information of the excavator, L is n + d + X is the reversing distance, n + d is the distance of n parking spaces d, and X is the length of the shovel arm of the excavator.
3. The method for controlling parking of an unmanned mining vehicle based on a parking control point of claim 2, wherein the step of determining the closest point of the main road of the excavator according to the excavator positioning information comprises:
acquiring preset road information of a mine, and acquiring positioning information of a current excavator, wherein the positioning information comprises longitude and latitude of the excavator and orientation angle information of a shovel arm;
calculating the distance from each point of the main road to the positioning point according to each point of the main road of the road information and the positioning point of the excavator;
taking the point with the closest distance from each point of the main road to the positioning point as the closest point of the main road of the excavator;
the closest point distance calculation formula is as follows:
Figure FDA0003131054630000012
wherein (x, y) is the positioning point coordinate of the excavator, (x)i,yi) Is the ith point coordinate of the main road.
4. The method for controlling parking of an unmanned mining vehicle based on a parking control point of claim 3, wherein the step of determining the intersection point and the return intersection point of the mining vehicle using the obtained closest point of the main road of the excavator comprises:
obtaining the closest point of a main road of the excavator and the current heading angle of the excavator;
judging whether an outward directed line segment of the direction of the excavator has an intersection point with the main road or not according to the current excavator direction angle;
if the intersection point exists, the position which takes the intersection point as a starting point and backs for a preset distance S is taken as an intersection point;
if no intersection point exists, the position with the closest point as a starting point and the preset distance S is backed off as an intersection point;
meanwhile, the position advanced by the preset distance S' by taking the closest point as a starting point is taken as a return trip intersection point.
5. The method for controlling parking of an unmanned mining vehicle based on a parking control point as claimed in claim 4, wherein the specific step of determining the reverse control point of the mining vehicle according to the turning control point and the intersection point of the mining vehicle comprises:
obtaining a turning control point and an excavator positioning point;
taking the turning control point as a plumb foot to serve as a vertical line of a line segment from the turning control point to the positioning point of the excavator;
then according to the foot drop, the preset distance S is setCBObtaining two points B1 and B2 on the vertical line as reversing control points;
the calculation formula of the reversing control point is as follows:
Figure FDA0003131054630000021
in the formula (x)C,yC) Is the coordinate of the turning control point, and theta is the angle number;
judging whether an angle between the turning control point as a vertex and an intersection point and a reversing control point as two sides is an obtuse angle or not;
if the angle is acute, the angle is obtuse, the final reversing control point is determined.
CN202110705541.4A 2021-06-24 2021-06-24 Unmanned mine car parking control method based on parking control point Active CN113581198B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110705541.4A CN113581198B (en) 2021-06-24 2021-06-24 Unmanned mine car parking control method based on parking control point

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110705541.4A CN113581198B (en) 2021-06-24 2021-06-24 Unmanned mine car parking control method based on parking control point

Publications (2)

Publication Number Publication Date
CN113581198A true CN113581198A (en) 2021-11-02
CN113581198B CN113581198B (en) 2022-08-05

Family

ID=78244533

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110705541.4A Active CN113581198B (en) 2021-06-24 2021-06-24 Unmanned mine car parking control method based on parking control point

Country Status (1)

Country Link
CN (1) CN113581198B (en)

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140225429A1 (en) * 2009-05-15 2014-08-14 Siemens Industry, Inc. System and method for providing auxiliary power by regeneration power management in mobile mining equipment
CN107856667A (en) * 2017-11-08 2018-03-30 科大讯飞股份有限公司 Auxiliary parking system and method
CN108773381A (en) * 2018-06-06 2018-11-09 厦门矿通科技有限公司 A kind of mine rail locomotive unmanned automatic driving system based on car running computer control
CN108873904A (en) * 2018-07-04 2018-11-23 北京踏歌智行科技有限公司 The unmanned parking scheme of mine vehicle, equipment and readable storage medium storing program for executing
CN109895784A (en) * 2017-12-07 2019-06-18 丰田自动车株式会社 Parking aid
CN110576848A (en) * 2019-08-27 2019-12-17 北京踏歌智行科技有限公司 Dynamic path planning method and device
CN111137277A (en) * 2018-11-05 2020-05-12 陕西汽车集团有限责任公司 Method for setting automatic parking position of unmanned mining vehicle
CN111152782A (en) * 2018-11-07 2020-05-15 陕西汽车集团有限责任公司 Automatic parking control system and control method
CN111474929A (en) * 2020-04-10 2020-07-31 三一智矿科技有限公司 Mine charging method and device
CN111572559A (en) * 2020-04-15 2020-08-25 北京踏歌智行科技有限公司 Interaction method for intelligent follow-up shovel of unmanned mine card in loading area
CN111600933A (en) * 2020-04-15 2020-08-28 北京踏歌智行科技有限公司 Mining area unmanned transportation system based on 5G and mine forklift cooperative control method thereof
CN112896147A (en) * 2019-12-04 2021-06-04 青岛慧拓智能机器有限公司 Bidirectional positioning parking control method and device for mining vehicle

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20140225429A1 (en) * 2009-05-15 2014-08-14 Siemens Industry, Inc. System and method for providing auxiliary power by regeneration power management in mobile mining equipment
CN107856667A (en) * 2017-11-08 2018-03-30 科大讯飞股份有限公司 Auxiliary parking system and method
CN109895784A (en) * 2017-12-07 2019-06-18 丰田自动车株式会社 Parking aid
CN108773381A (en) * 2018-06-06 2018-11-09 厦门矿通科技有限公司 A kind of mine rail locomotive unmanned automatic driving system based on car running computer control
CN108873904A (en) * 2018-07-04 2018-11-23 北京踏歌智行科技有限公司 The unmanned parking scheme of mine vehicle, equipment and readable storage medium storing program for executing
CN111137277A (en) * 2018-11-05 2020-05-12 陕西汽车集团有限责任公司 Method for setting automatic parking position of unmanned mining vehicle
CN111152782A (en) * 2018-11-07 2020-05-15 陕西汽车集团有限责任公司 Automatic parking control system and control method
CN110576848A (en) * 2019-08-27 2019-12-17 北京踏歌智行科技有限公司 Dynamic path planning method and device
CN112896147A (en) * 2019-12-04 2021-06-04 青岛慧拓智能机器有限公司 Bidirectional positioning parking control method and device for mining vehicle
CN111474929A (en) * 2020-04-10 2020-07-31 三一智矿科技有限公司 Mine charging method and device
CN111572559A (en) * 2020-04-15 2020-08-25 北京踏歌智行科技有限公司 Interaction method for intelligent follow-up shovel of unmanned mine card in loading area
CN111600933A (en) * 2020-04-15 2020-08-28 北京踏歌智行科技有限公司 Mining area unmanned transportation system based on 5G and mine forklift cooperative control method thereof

Also Published As

Publication number Publication date
CN113581198B (en) 2022-08-05

Similar Documents

Publication Publication Date Title
CN112964271B (en) Multi-scene-oriented automatic driving planning method and system
CN111426330B (en) Path generation method and device, unmanned transportation system and storage medium
JP6252235B2 (en) Automatic driving support system, automatic driving support method, and computer program
US9483056B2 (en) Vehicle control system
CN113916246A (en) Unmanned obstacle avoidance path planning method and system
CN106428007A (en) Autonomous driving control apparatus and method for vehicle
JPH11144185A (en) Automatic drive control guidance system
CN105806353A (en) Automatic driving device
CN106004860A (en) Vehicle traveling control device
CN113721637B (en) Intelligent vehicle dynamic obstacle avoidance path continuous planning method and system and storage medium
JP4327062B2 (en) Navigation device
CN107664993A (en) A kind of paths planning method
CN112256034B (en) Autonomous obstacle avoidance planning method and device
JP6339412B2 (en) Traffic control server
CN107664504A (en) A kind of path planning apparatus
CN113785252A (en) Method of parking an autonomously driven vehicle for autonomous charging
CN113932792B (en) Map updating system suitable for unmanned transportation system of surface mine
CN113670305A (en) Parking trajectory generation method and device, computer equipment and storage medium
CN113515111B (en) Vehicle obstacle avoidance path planning method and device
CN115071686A (en) Parking method for unmanned mining vehicle in long and narrow area
CN115564140A (en) Mining area unstructured road global and local path layered planning method and device
CN113593238B (en) Intersection virtual lane modeling method for automatic driving navigation
CN113581198B (en) Unmanned mine car parking control method based on parking control point
CN114326744A (en) Mine truck path planning method based on global map updating
CN110737261A (en) Automatic stop control method and system for vehicles

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant