SE533777C2 - Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles - Google Patents

Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles Download PDF

Info

Publication number
SE533777C2
SE533777C2 SE0950339A SE0950339A SE533777C2 SE 533777 C2 SE533777 C2 SE 533777C2 SE 0950339 A SE0950339 A SE 0950339A SE 0950339 A SE0950339 A SE 0950339A SE 533777 C2 SE533777 C2 SE 533777C2
Authority
SE
Sweden
Prior art keywords
vehicle
distance
angle sensor
image
hinge
Prior art date
Application number
SE0950339A
Other languages
Swedish (sv)
Other versions
SE0950339A1 (en
Inventor
Johan Larsson
Michael Krasser
Original Assignee
Atlas Copco Rock Drills Ab
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 Atlas Copco Rock Drills Ab filed Critical Atlas Copco Rock Drills Ab
Priority to SE0950339A priority Critical patent/SE533777C2/en
Priority to PCT/SE2010/050517 priority patent/WO2010132014A1/en
Publication of SE0950339A1 publication Critical patent/SE0950339A1/en
Publication of SE533777C2 publication Critical patent/SE533777C2/en

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/26Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
    • G01B11/27Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes for testing the alignment of axes
    • G01B11/272Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes for testing the alignment of axes using photoelectric detection means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D53/00Tractor-trailer combinations; Road trains
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D53/00Tractor-trailer combinations; Road trains
    • B62D53/02Tractor-trailer combinations; Road trains comprising a uniaxle tractor unit and a uniaxle trailer unit
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D53/00Tractor-trailer combinations; Road trains
    • B62D53/02Tractor-trailer combinations; Road trains comprising a uniaxle tractor unit and a uniaxle trailer unit
    • B62D53/021Tractor-trailer combinations; Road trains comprising a uniaxle tractor unit and a uniaxle trailer unit comprising a universal coupling joint
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D53/00Tractor-trailer combinations; Road trains
    • B62D53/02Tractor-trailer combinations; Road trains comprising a uniaxle tractor unit and a uniaxle trailer unit
    • B62D53/025Comprising a transmission shaft passing through the coupling joints
    • B62D53/026With all wheels powered
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D53/00Tractor-trailer combinations; Road trains
    • B62D53/04Tractor-trailer combinations; Road trains comprising a vehicle carrying an essential part of the other vehicle's load by having supporting means for the front or rear part of the other vehicle
    • B62D53/08Fifth wheel traction couplings
    • B62D53/0871Fifth wheel traction couplings with stabilising means, e.g. to prevent jack-knifing, pitching, rolling, buck jumping
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00Measuring arrangements characterised by the use of optical techniques
    • G01B11/26Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
    • G01B11/27Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes for testing the alignment of axes

Abstract

19 SAM MAN D RAG Föreliggande uppfinning hänför sig till en anordning och ett förfarande förkalibrering av en ledvinkelsensor (110) på ett fordon (100) innefattande ettförsta (100b) och ett andra parti (100a) förbundna med en led (107) förseddmed en ledvinkelsensor (1 10) för mätning av en ledvinkel (d) mellan det första(100b) och det andra partiet (100a). Enligt uppfinningen innefattas följande steg:placering av fordonet (100) så att ledvinkeln (d) är ungefär 0°, varvidledvinkelsensorn (110) indikerar en uppmätt ledvinkel; alstring av en bild somhar ett ledvinkelberoende läge (125, 126); projicering av bilden på föremålet(124); bestämning av bildens första läge (125) på föremålet (124); förflyttning avfordonet (100) mot eller från föremålet (124), så att ledvinkelsensorn (110)fortsätter att visa samma uppmätta ledvinkel; bestämning av bildens andra läge(126) på föremålet (124); och justering av ledvinkelsensorns (110) nolläge. Fig 3B SUMMARY The present invention relates to an apparatus and method for calibrating a hinge angle sensor (110) on a vehicle (100) comprising a first (100b) and a second portion (100a) connected to a hinge (107) provided with a hinge angle sensor. (1 10) for measuring an articulation angle (d) between the first (100b) and the second portion (100a). According to the invention, the following steps are included: positioning the vehicle (100) so that the articulation angle (d) is approximately 0 °, the articulation angle sensor (110) indicating a measured articulation angle; generating an image having a hinge angle dependent position (125, 126); projecting the image on the object (124); determining the first position (125) of the image on the object (124); moving the vehicle (100) toward or away from the object (124) so that the articulation angle sensor (110) continues to display the same measured articulation angle; determining the second position (126) of the image on the object (124); and adjusting the zero position of the articulation angle sensor (110). Fig. 3B

Description

25 533 ??? 2 autonomt, samtidigt som signaler från diverse på fordonet anordnade givare spelas in. l steg två utförs en ruttgenerering där, baserat på åtminstone en del av ovanstående inspelade givarsignaler, ett koordinatsystem skapas, vilket omfattar det område i vilket fordonet skall framföras. Den väg som fordonet körs vid ruttinspelningen beskrivs i detta koordinatsystem tillsammans med information om till exempel lämplig hastighet för olika delar av sträckan. 25 533 ??? 2 autonomously, at the same time as signals from various sensors arranged on the vehicle are recorded. In step two, a route generation is performed where, based on at least a part of the above recorded sensor signals, a coordinate system is created, which comprises the area in which the vehicle is to be driven. The road that the vehicle travels during the route recording is described in this coordinate system together with information about, for example, the appropriate speed for different parts of the route.

Det tredje steget utgörs av uppspelning, där koordinatinformation avseende hur fordonet framfördes manuellt. samt en representation av omgivningen används för att autonomt framföra fordonet längs samma sträcka som fordonet i steg ett framfördes manuellt.The third step consists of playback, where coordinate information regarding how the vehicle was driven manually. and a representation of the surroundings is used to autonomously drive the vehicle along the same distance as the vehicle in step one was driven manually.

Vid autonom uppspelning (tramming) av en rutt bestäms, t.ex. genom estimering, fordonets position i det koordinatsystem i vilket representation av omgivningen och önskad färdväg är definierade.During autonomous play (tramming) of a route it is determined, e.g. by estimation, the position of the vehicle in the coordinate system in which the representation of the surroundings and the desired route are fi niered.

Den representation av omgivningen som används vid positionsbestämningen kan utgöras av en kartrepresentation av väggarna i de tunnlar i vilka fordonet ska framföras autonomt, och kan antingen vara genererad på förhand eller genereras med hjälp av den ovan nämnda insamlade givarinforrnationen. När ruttgenereringen nått sitt slut kan således en representation ha genererats.The representation of the surroundings used in the position determination may consist of a map representation of the walls in the tunnels in which the vehicle is to be driven autonomously, and may either be generated in advance or generated by means of the above-mentioned collected sensor information. Thus, when the route generation has reached its end, a representation may have been generated.

Oavsett hur representationen av omgivningen har genererats är det i system av ovanstående typ mycket viktigt att den utgör en korrekt beskrivning av omgivningen, då det, om den av någon anledning skulle utgöra en dålig representation av hur omgivningen verkligen ser ut i motsvarande delar av rutten, finns en risk att fordonen tappar bort sig eller kör fel och orsakar skador på fordonen eller omgivningen.Regardless of how the representation of the environment has been generated, in systems of the above type it is very important that it constitutes a correct description of the environment, as if it for some reason constitutes a poor representation of what the environment really looks like in corresponding parts of the route, . there is a risk of the vehicles getting lost or driving incorrectly and causing damage to the vehicles or the environment.

De processer som används för att generera dylika representationer av omgivningen kan vara komplicerade och mycket kan gå fel. Såsom nämnts ovan kan kartgenereringen baseras på givarinformation från många olika givare. Exempel på dylika givare utgöras av midjevinkelgivare eller andra 10 15 20 25 533 TP? 3 ledvinkelsensorer, givare för att mäta förflyttad sträcka, och en eller flera laseravståndsskannrar eller andra avståndsskannrar.The processes used to generate such representations of the environment can be complicated and many things can go wrong. As mentioned above, the map generation can be based on sensor information from many different sensors. Examples of such sensors consist of waist angle sensors or other 10 15 20 25 533 TP? 3 articulation angle sensors, sensors for measuring the distance traveled, and one or more laser distance scanners or other distance scanners.

Ett av problemen med detta system är att det är känsligt för hur väl ledvinkelsensom är kalibrerad. För att fordonet med hög precision skall kunna följa den inspelade rutten är det viktigt att ledvinkelsensom är 'rätt kalibrerad, d.v.s. att den Iedvinkel är känd vid vilken en longitudinell förflyttning av fordonet inte resulterar i en lateral förflyttning eller en förändring av vinkeln mellan fordonets laterala centrumlinje och en yttre referens. Lämpligen kalibreras ledvinkelsensom så att dess nolläge sammanfaller med nämnda ledvinkel.One of the problems with this system is that it is sensitive to how well the joint angle is calibrated. In order for the vehicle to be able to follow the recorded route with high precision, it is important that the joint angle is correctly calibrated, i.e. that the right angle is known at which a longitudinal displacement of the vehicle does not result in a lateral movement or a change of the angle between the lateral centerline of the vehicle and an external reference. Suitably, the joint angle sensor is calibrated so that its zero position coincides with said joint angle.

Precisionskravet för att fordonen skall kunna följa en inspelad rutt vid hastigheter på storleksordningen 4-5 m/s eller högre med bibehållen ruttföljningsprecision är att ledvinkelsensom är kalíbrerad med en tolerans av storleksordningen ett par tiondels grader. Ett exempel för en viss banföljningsalgoritm är att ett kalibreringsfel på 1° motsvarar 25 cm lateral offset på banföliningen vid 5 m/s. Motsvarande siffra vid 8,3 rn/s är 0,7 m, eftersom offseten växer Detta överstiger precisionskravet för ett vanligt LH D-fordon som framförs manuellt. exponentiellt. precisionskrav vida På samma sätt är det känsligt för hur väl avstàndsskannrama är kalibrerade.The precision requirement for the vehicles to be able to follow a recorded route at speeds of the order of 4-5 m / s or higher while maintaining route tracking precision is that the joint angle calibrated with a tolerance of the order of a few tenths of a degree. An example of a certain trajectory algorithm is that a calibration error of 1 ° corresponds to 25 cm lateral offset on the trajectory at 5 m / s. The corresponding figure at 8.3 rn / s is 0.7 m, as the offset grows. This exceeds the precision requirement for a standard LH D vehicle that is driven manually. exponentially. precision requirements wide Similarly, it is sensitive to how well the distance scan frames are calibrated.

Precisionskravet ligger här på en tolerans av storleksordningen ett par tiondels grader.The precision requirement here is a tolerance of the order of a couple of tenths of a degree.

Det finns alltså ett behov av ett förfarande för kalibrering som uppfyller dessa höga precisionskrav.There is thus a need for a calibration procedure that meets these high precision requirements.

REDOGÖRELSE FÖR UPPFINNINGEN Det är ett syfte med föreliggande uppfinning att tillhandahålla ett förfarande för kalibrering av en ledvinkelsensor med en hög noggrannhet. Detta syfte uppnås med ett förfarande med kännetecken enligt patentkrav 1.DESCRIPTION OF THE INVENTION It is an object of the present invention to provide a method for calibrating a joint angle sensor with a high accuracy. This object is achieved with a method with features according to claim 1.

Föreliggande uppfinning hänför sig till en anordning och ett förfarande för kalibrering av en ledvinkelsensor på ett fordon, vilket fordon innefattar ett första parti och ett andra parti förbundna med en led, vilken led är försedd med en 10 15 20 25 533 777 4 ledvinkelsensor för mätning av en ledvinkel mellan det första partiet och det andra partiet. Enligt uppfinningen innefattar förfarandet stegen: Placering av fordonet så att ledvinkeln är ungefär 0°, varvid ledvinkelsensom indikerar en uppmätt ledvinkel. Alstring av en bild som har ett ledvinkelberoende läge.The present invention relates to a device and a method for calibrating a hinge angle sensor on a vehicle, which vehicle comprises a first portion and a second portion connected to a hinge, which hinge is provided with a hinge angle sensor for measurement. of a joint angle between the first portion and the second portion. According to the invention, the method comprises the steps of: Positioning the vehicle so that the articulation angle is approximately 0 °, the articulation angle indicating a measured articulation angle. Generating an image that has a hinge angle dependent position.

Projicering av bilden på ett första föremål. Bestämning av bildens första läge på det första föremålet. Förflyttning av fordonet en sträcka mot eller från det första föremålet, så att ledvinkelsensorn fortsätter att visa väsentligen samma uppmätta ledvinkel. Bestämning av bildens andra läge på det första föremålet.Projection of the image on a first object. Determining the first position of the image on the first object. Movement of the vehicle a distance towards or from the first object, so that the articulation angle sensor continues to show substantially the same measured articulation angle. Determining the second position of the image on the first object.

Justering av ledvinkelsensorns nolläge när ett avstånd mellan bildens första läge och andra läge är större än det avstånd som motsvarar minsta acceptabla fel i ledvinkelmätningen för den utförda förflyttningen.Adjustment of the zero position of the articulation angle sensor when a distance between the first position of the image and the second position is greater than the distance corresponding to the least acceptable error in the articulation angle measurement for the performed movement.

Fördelarna med detta förfarande är att en noggrann kalibrering erhålls på ett snabbt och säkert sätt och kan utföras av en ensam operatör.The advantages of this method are that an accurate calibration is obtained in a fast and safe way and can be performed by a single operator.

Enligt en utföringsforrn av uppfinningen innefattas även en anordning och ett förfarande för kalibrering av en avståndsskanner på ett fordon, vilket fordon innefattar ett första parti och ett andra parti förbundna med en led, vilken led är försedd med en ledvinkelsensor för mätning av en ledvinkel mellan det första partiet och det andra partiet. Enligt uppfinningen innefattar förfarandet stegen: Kalibrering av ledvinkelsensom. Placering av fordonet så att ledvinkelsensom indikerar nollåge. Alstring av en bild i en syltlinje. Projicering av bilden på ett andra föremål. Justering av avståndsskannems nolläge, så att det andra föremålet ligger i avståndsskan nems nolläge.According to an embodiment of the invention, there is also included a device and a method for calibrating a distance scanner on a vehicle, which vehicle comprises a first portion and a second portion connected to a hinge, which hinge is provided with a hinge angle sensor for measuring a hinge angle between it. the first party and the second party. According to the invention, the method comprises the steps of: Calibrating the joint angle sensor. Position the vehicle so that the joint angle indicates zero position. Generating an image in a jam line. Projection of the image on a second object. Adjusting the zero position of the distance scanner so that the other object is in the zero position of the distance scanner.

Fördelama med denna utföringsfonn är att en noggrann kalibrering erhålls på ett snabbt och säkert sätt och kan utföras av en ensam operatör.The advantages of this embodiment are that an accurate calibration is obtained in a fast and safe manner and can be performed by a single operator.

FIGURBESKRIVNING Uppfinningen ska nu förklaras närmare med hjälp av föredragna utföringsexempel och med hänvisning till bifogade ritningar, i vilka: Fig. 1A-C visar ett fordon från sidan respektive uppifrån, vid vilket föreliggande uppfinning med fördel kan användas. 10 15 20 25 533 77? 5 Fig. 2 visar ett exempel på en gruva där föreliggande uppfinning med fördel kan tillämpas.DESCRIPTION OF THE DRAWINGS The invention will now be explained in more detail with the aid of preferred embodiments and with reference to the accompanying drawings, in which: Figs. 1A-C show a vehicle from the side and from above, respectively, in which the present invention can be used to advantage. 10 15 20 25 533 77? Fig. 2 shows an example of a mine where the present invention can be advantageously applied.

Fig. 3A-B visar en anordning för kalibrering av en ledvinkelsensor Fig. 4 visar ett flödesschema för kalibrering av en ledvinkelsensor Fig. 5A-C visar en anordning för kalibrering av en avståndsskanner Fig. 6 visar ett flödesschema för kalibrering av en avståndsskanner FöREDRAeEN uTFöRrNGsFoRM Fig. 1A-C visar ett fordon 100 från sidan respektive uppifrån. Fordonet 100 utgör ett lastfordon vid vilken föreliggande uppfinning med fördel kan tillämpas.Fig. 3A-B shows a device for calibrating a hinge angle sensor. Fig. 4 shows a fate diagram for calibrating a hinge angle sensor. Fig. 5A-C shows a device for calibrating a distance scanner. Figs. 1A-C show a vehicle 100 from the side and from above, respectively. The vehicle 100 constitutes a truck to which the present invention can be advantageously applied.

Fordonet 100 innefattar en skopa 101, hjul 102-105 förbundna med hjulaxlar 113, 114, samt en styrenhet 106, vilken styr diverse av fordonets 100 funktioner. Såsom visas i fig. 1b utgörs fordonet av ett ledfordon, där ett främre parti 100a är sammanfogat med ett bakre parti 100b via en led 107. Leden 107 kan ställas in i önskad ledvinkel d. Vid leden 107 är anordnat en ledvinkelsensor 110, vilken mäter aktuell ledvinkel a och överför dessa signaler till styrenheten 106. Fordonet kan även innefatta t.ex. en hjulrotationssensor 108 såsom t.ex. en odometer, vilken kan vara anordnad vid den från transmissionen utgående axeln och avge signaler representerande drivhjulens rotation och/eller förflyttad sträcka. \f|dare innefattar fordonet 100 en inte visad motor eller annan anordning för att förflytta fordonet 100.The vehicle 100 comprises a bucket 101, wheels 102-105 connected to wheel axles 113, 114, and a control unit 106, which controls various of the functions of the vehicle 100. As shown in fi g. 1b, the vehicle is a hinge vehicle, where a front portion 100a is joined to a rear portion 100b via a hinge 107. The hinge 107 can be set to the desired hinge angle d. these signals to the control unit 106. The vehicle may also include e.g. a wheel rotation sensor 108 such as e.g. an odometer, which can be arranged at the shaft emanating from the transmission and emit signals representing the rotation of the drive wheels and / or the distance traveled. Further, the vehicle 100 includes an engine or other device (not shown) for moving the vehicle 100.

Fordonet 100 innefattar vidare en främre 111 och en bakre 112 laseravståndsskanner i varsitt laserhus, vilka laseravståndsskannrar 111, 112 också är förbundna med styrenheten 106 och avger sensorsignaler representerande uppmätta avstånd, dvs. avstånd till närmaste hinder som stoppar laserstrålens väg. Laseravståndsskannrarna 111, 112 kan, exempelvis, vara anordnade att mäta avståndet i vissa riktningar i ett vinkelintervall. I föreliggande exempel används laseravståndsskannrar som mäter avståndet till närmaste objekt i det främre partiets 100a längdriktning framåt (respektive i det bakre partiets längdriktning 100b bakåt) och avståndet till närmaste objekt 10 15 20 25 30 533 77? 6 (såsom berg) för vane hel grad i 90° från respektive längdriktning. Varje respektive laseravståndsskanner mäter således avstånd vid 181 respektive mätpunkter. Såsom inses kan naturligtvis laseravståndsskannrar som mäter avstånd i betydligt fler riktningar användas, liksom även sådana som mäter avstånd i betydligt färre riktningar. Likaså kan en enda rundstrålande laser istället användas. l en altemativ exempelutföringsforrn används endast den skanner som för tillfället ”pekar” i färdriktningen (dvs. den främre 111 om fordonet körs framlänges och vice versa). Det är heller inte essentiellt för uppfinningen att riktningama uppmäts via laseravståndsskannrar, utan godtyckliga avståndsmätare kan användas, så länge som dessa kan tillhandahålla avståndsmätningar med acceptabel noggrannhet. Exempel på andra typer av tänkbara avståndsmätare utgörs av avståndsmätare baserade på radarteknik eller sonarteknik.The vehicle 100 further comprises a front 111 and a rear 112 laser distance scanner in each laser housing, which laser distance scanners 111, 112 are also connected to the control unit 106 and emit sensor signals representing measured distances, i.e. distance to the nearest obstacle that stops the path of the laser beam. The laser distance scanners 111, 112 may, for example, be arranged to measure the distance in certain directions in an angular range. In the present example, laser distance scanners are used which measure the distance to the nearest object in the longitudinal direction of the front portion 100a forward (respectively in the longitudinal direction of the rear portion 100b backward) and the distance to the nearest object 10 15 20 25 30 533 77? 6 (as rock) for habit full degree at 90 ° from the respective longitudinal direction. Each respective laser distance scanner thus measures distances at 181 respective measuring points. As will be appreciated, of course, laser distance scanners that measure distances in significantly different directions can be used, as well as those that measure distances in significantly fewer directions. Likewise, a single omnidirectional laser can be used instead. In an alternative exemplary embodiment, only the scanner that is currently “pointing” in the direction of travel is used (ie the front 111 if the vehicle is driven forwards and vice versa). It is also not essential for the invention that the directions are measured via laser distance scanners, but arbitrary distance meters can be used, as long as these can provide distance measurements with acceptable accuracy. Examples of other types of possible distance meters consist of distance meters based on radar technology or sonar technology.

Vidare används i den här visade exempelutföringsfonnen en avståndsskanner som mäter avstånd i enbart ett plan (fordonens horisontalplan). Det skall dock inses att avståndsskanning kan ske fler än ett plan, t.ex. även i ett vertikalplan för att mäta tunnel-lorthöjd, eller andra emellan horisontal- och vertikalplan liggande plan, och därmed positionsestimering. I en ytterligare alternativ exempelutföringsforrn kan istället, eller i tillägg därtill, en eller flera skannrar som är riktade åt sidorna användas. förfina möjlighetema till en korrekt Vidare avger de ovannämnda sensorema sensorsignaler till styrenheten 106 vid tillämpliga tidpunkter, såsom t.ex. kontinuerligt eller var 40 ms eller oftare eller mer sällan. Styrenheten 106 använder sedan mottagna signaler enligt vad som kommer att beskrivas nedan. l fig. 2 visas ett exempel på en gruva där föreliggande uppfinning med fördel kan tillämpas. l det visade exemplet lastar fordonet 100 med hjälp av skopan 101 bergmassor vid platsen A för att sedan transportera lastade massor för dumpning vid platsen B. När fordonet 100 skall inrättas för autotramming kan t.ex. tillämpas den ovan beskrivna trestegspnncipen, det vill säga först utförs en ruttinspelning där en sensorsignalinspelning av signaler från ovanstående sensorer aktiveras. 10 15 20 25 30 533 777 7 Förfarandet lastning-transport-dumpning-återförflyttning kan vara anordnat att utföras som en enda rutt, men vanligtvis utförs förflyttning från A till B som en första separat rutt och förflyttningen från B till A som en andra separat rutt. För inspelning av en rutt från A till B aktiveras således sensorsignalinspelningen, varvid en operatör med fordonet uppställt vid punkten A backar mot punkten C för att därmed vända fordonet, varvid transport enligt streckad linje sedan utförs till punkt B där ruttinspelningen stoppas.Furthermore, in the exemplary embodiment shown here, a distance scanner is used which measures distance in only one plane (the horizontal plane of the vehicles). It should be understood, however, that distance scanning can take place än more than one plane, e.g. also in a vertical plane for measuring tunnel height, or other planes lying between horizontal and vertical planes, and thus position estimation. In a further alternative exemplary embodiment, one or more of the side-facing scanners may instead be used, or in addition thereto. further refine the possibilities of a correct Furthermore, the above-mentioned sensors emit sensor signals to the control unit 106 at applicable times, such as e.g. continuously or every 40 ms or more often or less frequently. The controller 106 then uses received signals as will be described below. l fi g. 2 shows an example of a mine where the present invention can be advantageously applied. In the example shown, the vehicle 100 loads rock masses at site A by means of the bucket 101 and then transports loaded masses for dumping at site B. When the vehicle 100 is to be set up for autotramming, e.g. the three-step principle described above is applied, i.e. first a route recording is performed where a sensor signal recording of signals from the above sensors is activated. The loading-transport-dump-return-transfer procedure may be arranged to be performed as a single route, but usually the transfer from A to B is performed as a first separate route and the transfer from B to A as a second separate route. . For recording a route from A to B, the sensor signal recording is thus activated, whereby an operator with the vehicle stationed at point A reverses towards point C to thereby turn the vehicle, whereby transport according to a dashed line is then performed to point B where the route recording is stopped.

Baserat på de inspelade givarsignalema skapas sedan rutten, det vill säga hur fordonet skall framföras och med vilken hastighet fordonet bör framföras vid olika delar av rutten. Såsom nämnts ovan kan sensorsignalerna avläsas t.ex. var 40 ms. Om varje sensorsignalavläsning skulle utgöra en ruttpunktbllr antalet ruttpunkter mycket omfattande. Av denna anledning kan ruttpunktema istället utgöras av signaler som bestäms vid t.ex. varje halvmeter fordonet rört sig. De data som lagras för rutten är företrädesvis positionen, fordonets riktning och önskad hastighet. Således erhålls en rutt som i princip består av ett antal punkter, där för varje punkt alltså anges var fordonet ska befinna sig, vilken riktning det bör ha och den hastighet med vilken den ska framföras vid efterföljande autotramming.Based on the recorded sensor signals, the route is then created, ie how the vehicle is to be driven and at what speed the vehicle should be driven at different parts of the route. As mentioned above, the sensor signals can be read e.g. was 40 ms. If each sensor signal reading were to constitute a route point, the number of route points would be very extensive. For this reason, the route points can instead consist of signals determined at e.g. every half meter the vehicle moved. The data stored for the route is preferably the position, the direction of the vehicle and the desired speed. Thus, a route is obtained which in principle consists of a number of points, where for each point it is stated where the vehicle is to be, what direction it should be and the speed with which it is to be driven during subsequent autotramming.

När sedan fordonet autonomt skall förflytta sig enligt rutten räcker dock, såsom nämnts ovan, normalt inte enbart denna information för att önskad förflyttning ska kunna utföras, t.ex. p.g.a. att osäkerheter i sensorsignalema medför att slutpositionen med stor sannolikhet kommer att awika från den beräknade, varvid också startpositionen vid nästa rutt kommer att awika från den ursprungliga. Av denna anledning används även en representation av omgivningen, såsom t.ex. ruttkartor, för att kunna jämföra signaler som uppmäts vid autotrammingen med kartan för att därmed säkrare kunna bestämma fordonets position, och med jämna mellanrum återställa osäkerheter i den estimerade positionen.However, when the vehicle is then to move autonomously along the route, as mentioned above, this information alone is not normally sufficient for the desired movement to be carried out, e.g. p.g.a. that uncertainties in the sensor signals mean that the end position will in all probability deviate from the calculated one, whereby also the start position at the next route will deviate from the original one. For this reason, a representation of the environment is also used, such as e.g. route maps, in order to be able to compare signals measured during the auto tram with the map in order to be able to more accurately determine the position of the vehicle, and to periodically restore uncertainties in the estimated position.

Representationen av omgivningen (ruttkartoma) kan exempelvis bestå av ett koordinatsystem som med fördel kan vara lokalt för den specifika rutten och som också. kan skapas baserat på de inspelade sensorsignalerna. 10 15 20 25 30 533 77? 8 Koordinatsystemet behöver således endast omfatta det omrâde i vilket fordonet skall framföras, och kan ha sitt origo där den punkt på fordonet som utgör referens vid positioneringen, såsom t.ex. mitten på fordonets framaxel, befinner sig när inspelningen startas. n Den väg som fordonet körs vid ruttinspelningen kan sedan beskrivas i detta koordinatsystem tillsammans med information om till exempel lämplig hastighet för olika delar av sträckan.The representation of the surroundings (route maps) can, for example, consist of a coordinate system which can advantageously be local to the specific route and which also. can be created based on the recorded sensor signals. 10 15 20 25 30 533 77? The coordinate system thus only needs to cover the area in which the vehicle is to be driven, and can have its origin where the point on the vehicle that constitutes a reference during positioning, such as e.g. center on the front axle of the vehicle, stops when recording starts. n The road that the vehicle travels during the route recording can then be described in this coordinate system together with information about, for example, the appropriate speed for different parts of the route.

När ruttgenereringen nått sitt slut kan således en representation motsvarande den i fig. 2 visade ha genererats, vilken sedan kan användas vid efterföljande ruttuppspelning. Således kan man säga att, efter det att kartan har genererats, tillståndet för varje ruta i kartan är en funktion av uppmätt avstånd av alla laserstràlar som har träffat/passerat genom rutan under mätningama. Kartan kan representeras av ett relativt finmaskigt rutnät, till exempel med en upplösning på 1 cm eller 1 dm/ruta.Thus, when the route generation has reached its end, a representation corresponding to that in fi g. 2 has been generated, which can then be used in subsequent route playback. Thus, it can be said that, after the map has been generated, the state of each box in the map is a function of the measured distance of all the laser beams that have hit / passed through the box during the measurements. The map can be represented by a relatively mesh grid, for example with a resolution of 1 cm or 1 dm / square.

Såsom nämnts ovan' är ett problem med dylika kartor, oavsett typ, att omgivningen där rutten spelas in kan vara sådan att kartans kvalitet blir dålig, exempelvis p.g.a. förekomst av föremål eller ytor som absorberar eller reflekterar bort kartgenereringen på givarinfomtation från många olika givare såsom ledvinkelsensor, mäta förflyltad sträcka och laseravståndsskannrar, och ivissa fall även information från ett gyro som mäter ljuset från laseravståndsskannrama. Wdare baseras givare för att fordonens färdriktning. Om en eller flera av dessa givare avger felaktig information blir kartan sannolikt också felaktig. Dessutom behövs detaljerad geometrisk information om fordonkonstruktion och givarplacering på fordonen för att kartorna skall bli en relevant representation av omgivningen.As mentioned above, a problem with such maps, regardless of type, is that the environment in which the route is recorded may be such that the quality of the map becomes poor, for example due to the presence of objects or surfaces that absorb or re-reflect the map generation on sensor information from many different sensors such as hinge angle sensor, measured distance and laser distance scanners, and in some cases also information from a gyro that measures the light from the laser distance scanner frames. Wdare based sensors to the direction of travel of the vehicles. If one or more of these sensors provide incorrect information, the map will probably also be incorrect. In addition, detailed geometric information about vehicle construction and sensor placement on the vehicles is needed for the maps to become a relevant representation of the environment.

Under utvecklingen av systemet har ett manuellt förfarande använts för att kalibrera ledvinkelsensorn 110. Detta förfarande går ut på att en person står på ”stötfångaren“ bakom fordonets 100 kylare och skapar en syftlinje över centrum av Iaserhusen 111, 112. Genom att iaktta hur denna syftlinje förflyttar sig relativt något avlägset stillastående föremål när fordonet 100 körs en sträcka av 20-30 m fås ett mått på om fordonet står rakt med leden. D.v.s. om ledvinkeln befinner 10 15 20 25 30 533 77? 9 sig i sitt korrekta nolläge, så ligger den tidigare bestämda syftlinjen fast på en och samma punkt på det avlägsna föremålet.During the development of the system, a manual method has been used to calibrate the articulation angle sensor 110. This method involves a person standing on the "bumper" behind the vehicle's cooler 100 and creating a line of sight over the center of Iaserhusen 111, 112. By observing how this line of sight moves relatively slightly distant stationary objects when the vehicle 100 is driven a distance of 20-30 m, a measure is obtained of whether the vehicle is straight with the joint. I.e. whether the joint angle starts 10 15 20 25 30 533 77? 9 in its correct zero position, the previously determined line of sight is fixed at one and the same point on the distant object.

Om å andra sidan leden 7 står något vinklad, så kommer fordonet 100 att- svänga och syftlinjen kommer inte längre att peka på en och samma punkt när fordonet 100 körs framåt eller bakåt. Genom att med detta syftlinjeförfarande utvärdera hur fordonet 100 svänger vid olika ledvinkellägen kan det läge som motsvarar att fordonet 100 åker rakt fram bestämmas, d.v.s. den vinkel som skall anses vara ledvinkelns nolläge.If, on the other hand, the joint 7 is slightly angled, the vehicle 100 will turn and the line of sight will no longer point to one and the same point when the vehicle 100 is driven forwards or backwards. By evaluating with this aim line procedure how the vehicle 100 turns at different articulation positions, the position corresponding to the vehicle 100 going straight ahead can be determined, i.e. the angle to be considered as the zero position of the hinge angle.

Detta förfarande har flera brister, varav de viktigaste är: 1) I vissa länder finns regler som inte tillåter att människor står eller hänger på fordonet medan det framförs. 2) Förfarandet kräver minst två personer - en förare och en som står och bedömer hur syftlinjen flyttar. 3) Precisionen blir beroende av hur väl den som avläser syftlinjen kan bedöma hur fordonen svänger. 4) Förfarandet är mycket tidsödande eftersom fordonsoperatören och syftaren måste kommunicera mellan varje prov om hur ledvinkeln skall ändras.This procedure has your shortcomings, the most important of which are: 1) In some countries there are rules that do not allow people to stand or hang on the vehicle while driving. 2) The procedure requires at least two people - one driver and one who assesses how the line of sight fl works. 3) The precision will depend on how well the person reading the line of sight can assess how the vehicles turn. 4) The procedure is very time consuming as the vehicle operator and the aimer have to communicate between each test on how to change the articulation angle.

I figur 3A och B visas en anordning för en automatiserad variant av detta förfarande. W tänker oss, jämför Fig. 1C, att det finns en lateral centrumlinje 115 för det första partiet 100b och en lateral centrumlinje 116 för det andra partiet 100a, där en centrumlinje är en linje som går mitt emellan hjulen 103, 105, 102, 104 på respektive parti 100b, 100a och är vinkelrät mot respektive partis hjulaxel 113, 114. Om ledvinkeln u är 0°, så kommer dessa centrumlinjer 115 och 116 att sammanfalla eller vara parallella. Denna insikt utnyttjas i uppfinningens utföringsforrn nedan. l exemplet i Figur 3A och B, så är laserhusen 111 och 112 anordnade på centrumlinjerna 115, 116 (jämför Fig 1C), varför anordning på laserhusen 111, 112 är fördelaktigt. En spaltlaser 121 är monterad på det första laserhuset 112 på det första partiet 1-00b och ett hinder 122 i form av en platta eller liknande med ett hål 123 är monterat på det andra laserhuset 111 på det andra partiet 100a. Företrädesvis är hålet 123 en vertikal slits som är t.ex. ca 10 mm bred och ca 5-10 cm hög. En tänkt syltlinje 120 passerar spaltlasern 121 och hindret 122. 10. 15 20 25 533 77? 10 Spaltlasern 121 är utformad så att den genererar en laserlinje i ett horisontellt plan och har fästen för att kunna fästas på det första laserhuset 112, så att spaltlasems 121 centrum befinner sig i det första partiets 100b centrumlinje 115. Uppfinningen fungerar naturligtvis även om spaltlasern 121 och hindret 122 är anordnade på var sitt parti 100b, 100a på andra platser längs centrumlinjerna 115, 116 än på laserhusen 111, 112, alternativt anordnade parallellt på lika avstånd från centrumlinjema 115, 116.Figures 3A and B show a device for an automated variant of this method. W imagine, compare Fig. 1C, that there is a lateral centerline 115 for the first portion 100b and a lateral centerline 116 for the second portion 100a, where a centerline is a line running midway between the wheels 103, 105, 102, 104. on each portion 100b, 100a and is perpendicular to the wheel axis 113, 114 of each portion. If the angle of inclination u is 0 °, then these center lines 115 and 116 will coincide or be parallel. This insight is used in the embodiment of the invention below. In the example of Figures 3A and B, the laser housings 111 and 112 are arranged on the center lines 115, 116 (compare Fig. 1C), so arrangement on the laser housings 111, 112 is advantageous. A slit laser 121 is mounted on the first laser housing 112 on the first portion 1-00b and an obstacle 122 in the form of a plate or the like with a hole 123 is mounted on the second laser housing 111 on the second portion 100a. Preferably, the hole 123 is a vertical slot which is e.g. about 10 mm wide and about 5-10 cm high. An imaginary jam line 120 passes the slit laser 121 and the obstacle 122. 10. 15 20 25 533 77? The slit laser 121 is designed to generate a laser line in a horizontal plane and has brackets for attachment to the first laser housing 112, so that the center of the slit laser 121 is in the center line 115b of the first portion 100b. and the obstacle 122 are arranged at respective portions 100b, 100a at locations other along the center lines 115, 116 than on the laser housings 111, 112, alternatively arranged in parallel at equal distances from the center lines 115, 116.

Det är också möjligt att använda andra typer av ljus än spaltlaser. På samma sätt är det tänkbart att använda ett annat medium än ljus, t.ex. andra elektromagnetiska vägor,- företrädesvis radar. Vidare är det tänkbart att använda ljud, företrädesvis baserat på sonarteknik eller någon typ av partikelstråle, såsom vatten eller färg.It is also possible to use other types of light than slit lasers. In the same way, it is conceivable to use a medium other than light, e.g. other electromagnetic paths, - preferably radar. Furthermore, it is conceivable to use sound, preferably based on sonar technique or some type of particle beam, such as water or paint.

När spaltlasern 121 lyser framåt, så kommer hindret 122 att delvis skymma ljuset, utom i slitsen 123. Därmed fås en punktlaser, vars punkt kan projiceras 'som en bild på ett första föremål 124 för kalibrering av ledvinkelsensom 110.When the slit laser 121 illuminates forward, the obstacle 122 will partially obscure the light, except in the slit 123. This provides a point laser, the point of which can be projected as an image of a first object 124 for calibrating the articulation angle sensor 110.

Naturligtvis kan en annan projicerad bild än en punkt användas, t.ex. en vertikal linje eller någon mer komplicerad bild. Det skulle också vara möjligt att skapa en projektion inte genom ett hål, utan t.ex. längs en kant ellerpå båda sidor av en pinne. Ordet ”bild” ska tolkas brett och inkludera även ett mönster som t.ex. genereras med ljud eller andra sätt.Of course, a projected image other than a point can be used, e.g. a vertical line or some more complicated image. It would also be possible to create a projection not through a hole, but e.g. along an edge or on both sides of a stick. The word "image" should be interpreted broadly and also include a pattern such as. generated by sound or other means.

Det första föremålet 124 kan vara vad som helst där bilden kan ses. Det är lättast om det första föremålet 124 står still.The first object 124 can be anything where the image can be seen. It is easiest if the first object 124 is stationary.

Det skulle också vara möjligt att kalibrera ledvinkelsensorn 110 genom att välja någon annan ledvinkelberoende egenskap hos bilden än läge på det första föremålet 124.It would also be possible to calibrate the hinge angle sensor 110 by selecting any other hinge angle dependent property of the image other than position on the first object 124.

Förfarandet för kalibrering av ledvinkelsensorn blir då, se Fig 4., att fordonet 100 'placeras så att ledvinkeln a är ungefär 0° och så att syftlinjen 120 pekar mot det första föremålet 124, steg 210. Ledvinkelsensorn 110 indikerar då en uppmätt ledvinkel som borde vara ungefär O°. Punktlasern 121, 122 alstrar en 10 15 20 25 30 533 7'?7 11 bild i form av t.ex. en punkt, steg 220, som projiceras på det första föremålet 124 i ett första läge 125, steg 230. Bildens första läge 125 bestäms, steg 240.The method for calibrating the articulation angle sensor then becomes, see Fig. 4, that the vehicle 100 'is positioned so that the articulation angle α is approximately 0 ° and so that the aiming line 120 points towards the first object 124, step 210. The articulation angle sensor 110 then indicates a measured articulation angle which should be about 0 °. The dot laser 121, 122 generates a 10 15 20 25 30 533 7 '? 7 11 image in the form of e.g. a point, step 220, which is projected on the first object 124 in a first position 125, step 230. The first position 125 of the image is determined, step 240.

Detta kan ske manuellt t.ex. genom att lägga på minnet var bildens första läge 125 är eller genom att göra en markering med t.ex. en penna. Detta kan också ske automatiskt genom att det första föremålet 124 är känsligt för ljuset eller andra mediet som når det första föremålet 124, så att t.ex. bildens första läge 125 lagras elektroniskt.This can be done manually e.g. by memorizing where the image's first position 125 is or by making a selection with e.g. a pen. This can also be done automatically by the first object 124 being sensitive to the light or second medium reaching the first object 124, so that e.g. the first position 125 of the image is stored electronically.

Sedan förflyttas fordonet 100 mot ellerfrån det första föremålet 124 kanske 20- 30 meter, utan att aktivt ändra ledvinkeln på fordonet, så att ledvinkelsensom 110 hela tiden väsentligen fortsätter att visa samma uppmätta ledvinkel, steg 250. Bilden beflnner sig då efter fordonets förflyttning i ett andra läge 126, vilket andra läge 126 bestäms, steg 260. Om nu ledvinkeln a är i sitt perfekta nolläge, så är det andra läget 126 detsamma som det första läget 125.Then the vehicle 100 is moved towards or from the first object 124 perhaps 20-30 meters, without actively changing the joint angle of the vehicle, so that the joint angle sensor 110 always substantially continues to show the same measured joint angle, step 250. The image then reflects after the vehicle's movement in a second position 126, which second position 126 is determined, step 260. If now the joint angle α is in its perfect zero position, then the second position 126 is the same as the first position 125.

Men om leden 107 står något vinklad, så kommer fordonet 100 att svänga något och syftlinjen 120 pekar inte längre på samma ställe på det första föremålet 124, d.v.s. bilden har flyttat sig till ett andra läge 126. Avståndet mellan bildens första läge 125 och bildens andra läge 126 motsvarar felet i den tidigare ledvinkelkalibreringen. Det håll som bilden har flyttat sig åt talar om åt vilket håll som kalibreringen ska ske. Justering kan då ske av ledvinkelsensoms 110 nolläge, steg 270, t.ex. genom att ändra offset i mätningen. Normalt blir det så att om bilden på det förstaföremålet 124 rört sig åt höger från fordonet sett, då fordonet har körts framåt, så har fordonet svängt medurs och ledvinkelns verkliga nolläge beflnner sig då en vinkel moturs från den under förflyttníngen uppmätta ledvinkeln.But if the trail 107 is slightly angled, then the vehicle 100 will turn slightly and the line of sight 120 will no longer point in the same place on the first object 124, i.e. the image has fl moved to a second position 126. The distance between the first position 125 of the image and the second position 126 of the image corresponds to the error in the previous hinge angle calibration. The direction in which the image has been talar indicates which direction the calibration should take place. Adjustment can then be made of the zero position of the articulation angle sensor 110, step 270, e.g. by changing the offset in the measurement. Normally, if the image of the first object 124 moves to the right of the vehicle, when the vehicle has been driven forward, the vehicle has turned clockwise and the actual zero position of the articulation angle then becomes an angle counterclockwise from the articulated angle measured during the movement.

Om det första föremålet 124 kan lagra bildens första läge 125 och andra läge 126, så kan kalibreringen ske automatiskt, med hjälp av t.ex. styrenheten 106.If the first object 124 can store the image's first position 125 and second position 126, then the calibration can take place automatically, by means of e.g. the control unit 106.

Annars kan en operatör räkna ut manuellt hur mycket ledvinkelsensorns 110 nolläge ska justeras och åt vilket håll.Otherwise, an operator can manually calculate how much the zero position of the articulation angle sensor 110 should be adjusted and in which direction.

Efter kalibreringen av ledvinkelsensom 110, så kan testet lämpligen göras om för att kontrollera att det blev rätt. Annars upprepas förfarandet tills tillräcklig precision uppnåtts. Antingen kan fordonet köras fram och tillbaka på samma 10 15 20 25 30 533 77? 12 område eller också kan fordonet fortsätta i samma riktning med omställning av ledvinkeln mellan varje köming. Lämpligen kalibreras ledvinkelsensorn 110, så att felet blir mindre än 0,5°, företrädesvis mindre än 0,1°.After the calibration of the articulation angle sensor 110, the test can be conveniently repeated to check that it was correct. Otherwise, the procedure is repeated until sufficient precision is achieved. Either the vehicle can be driven back and forth on the same 10 15 20 25 30 533 77? 12 area or the vehicle can continue in the same direction with adjustment of the joint angle between each turn. Suitably, the hinge angle sensor 110 is calibrated so that the error becomes less than 0.5 °, preferably less than 0.1 °.

Fördelama med att kalibrera ledvinkelsensom 110 på detta sätt är att det bara behövs en operatör för att genomföra kalibreringen. Kalibreringen går också snabbare eftersom operatören inte behöver kommunicera med andra.The advantage of calibrating the articulation angle sensor 110 in this way is that only one operator is needed to perform the calibration. Calibration is also faster because the operator does not need to communicate with others.

Dessutom blir kalibreringen noggrannare eftersom ett kvantitativt mått fås på kalibreringsprecisionen.In addition, the calibration becomes more accurate because a quantitative measure of the calibration precision is obtained.

En vâlkalibrerad ledvinkelsensor 110 kan också användas för att kalibrera fordonets laseravståndsskannrar 111, 112 eller andra avståndsskannrar av t.ex. typen radar eller sonar. För att göra en korrekt karta av omgivningen är det nödvändigt att även avståndsskannrama 111, 112 är monterade på korrekt plats och i korrekt vinkel i förhållande till en referenspunkt och riktning på fordonet 100. Att avståndsskannem 111, 112 är monterad på korrekt plats går relativt enkelt att mäta med tillfredsställande precision, medan det är avsevärt svårare att mäta om avståndsskannern 111, 112 är monterad i korrekt riktning.A well-calibrated hinge angle sensor 110 can also be used to calibrate the vehicle's laser distance scanners 111, 112 or other distance scanners of e.g. type of radar or sonar. In order to make a correct map of the surroundings, it is necessary that also the distance scanner frames 111, 112 are mounted in the correct place and at the correct angle in relation to a reference point and direction of the vehicle 100. That the distance scanner 111, 112 is mounted in the correct place is relatively simple. to measure with satisfactory precision, while it is considerably more difficult to measure if the distance scanner 111, 112 is mounted in the correct direction.

Precisionskravet för riktningen hos avståndsskannem 111, 112 i förhållande till fordonets 100 referensriktning är i storleksordningen några tiondels grader.The precision requirement for the direction of the distance scanner 111, 112 in relation to the reference direction of the vehicle 100 is in the order of a few tenths of a degree.

Referensriktningen väljs centrumlinjen 115, 116. lämpligen parallellt eller sammanfallande med Under utvecklingen av systemet har ett manuellt förfarande använts för att veriflera att avståndsskannrama är monterade i korrekt riktning. Detta förfarande går ut på att två personer håller upp träskivor i respektive avståndsskanners 111, 112 mätplan, medan data från avståndsskannrama 111, 112 lagras i en fil. Träskivorna hålls så att de bildar hörn motsvarande fordonets 100 hörn, men parallellförskjutet upp till avståndsskannerns 111, 112 mätplan.The reference direction is selected from the center line 115, 116. suitably parallel or coincident with During the development of the system, a manual procedure has been used to ensure that the distance scanner frames are mounted in the correct direction. This method involves two people holding up wooden boards in the measuring plane 111, 112 of the respective distance scanners 111, while data from the distance scanning frames 111, 112 are stored in a file. The wooden boards are held so that they form corners corresponding to the corners of the vehicle 100, but offset parallel to the measuring plane of the distance scanner 111, 112.

Genom att analysera det i nämnda fil lagrade datat, med avseende på om de i datat registrerade hömen uppträder symmetriskt, så kan ett mått fås på huruvida avståndsskannrama 111, 112 är monterade i korrekt riktning. i Problemen med detta förfarande är bl.a. att det kräver att flera personer hjälps åt. Dessutom blir precisionen beroende av hur väl de som lyfter träskivorna 10 15 20 25 30 535' 77? 13 lyckas hålla dessa iett läge som ger en korrekt bild av fordonets 100 höm i laserplanet. Wdare finns en stor osäkerhet i mätningen eftersom den utgår ifrån att fordonets 100 hörn är symmetriskt placerade med avseende på fordonets 100 laterala centrumlinje.By analyzing the data stored in said fi 1, with respect to whether the corners registered in the data appear symmetrically, a measure can be obtained of whether the distance scanner frames 111, 112 are mounted in the correct direction. The problems with this procedure are i.a. that it requires fl your people help. In addition, the precision depends on how well those who lift the wooden boards 10 15 20 25 30 535 '77? 13 manages to keep these in a position which gives a correct picture of the vehicle's corner in the laser plane. There is a great deal of uncertainty in the measurement because it assumes that the corners of the vehicle 100 are symmetrically placed with respect to the lateral centerline of the vehicle 100.

I flgur 5A-C visas en anordning för kalibrering av den främre avståndsskannem 111. För att kalibrera avståndsskannem behöver en syftlinje vara känd.Figures 5A-C show a device for calibrating the front distance scanner 111. To calibrate the distance scanner, a line of sight must be known.

Syftlinjen 120 ska i detta fall lämpligen vara en tänkt linje som går igenom den avståndsskanner 111, 112 som ska kalibreras och som sammanfaller med eller är parallell med centrumlinjen 115, 116 på det parti 100a, 100b som avståndsskannem 111, 112 är anordnad. Ettjenkelt sätt att hitta syftlinjen är genom metoden beskriven ovan för ledvinkelsensorn 110, även om naturligtvis andra metoder finns. Företrädesvis kalibreras alltså ledvinkelsensom 110 först, steg 310 i Fig. 6, innan kalibreringen av avståndsskannem 111 sker.The target line 120 in this case should suitably be an imaginary line passing through the distance scanner 111, 112 to be calibrated and coinciding with or parallel to the center line 115, 116 of the portion 100a, 100b of which the distance scanner 111, 112 is arranged. An easy way to find the line of sight is through the method described above for the articulation angle sensor 110, although of course other methods exist. Preferably, the hinge angle sensor 110 is thus calibrated first, step 310 in Fig. 6, before the calibration of the distance scanner 111 takes place.

Samma utrustning kan användas för kalibreringen av avståndsskannem 111 som för kalibreringen av ledvinkelsensom 110, d.v.s. en spaltlaser eller liknande 121 och ett hinder i form av t.ex. en platta eller liknande 122 med en slits eller liknande 123, vilket tillsammans fungerar som en punktlaser eller liknande.The same equipment can be used for the calibration of the distance scanner 111 as for the calibration of the articulation angle sensor 110, i.e. a slit laser or the like 121 and an obstacle in the form of e.g. a plate or the like 122 with a slot or the like 123, which together act as a dot laser or the like.

Dessutom används ett andra föremål 140, företrädesvis i form av en vertikal stång. Det är .också tänkbart att det andra föremålet 140 är t.ex. en stor plåt med ett vertikalt hål i. Det viktiga i sammanhanget är att ha ett andra föremål 140 som gör att det är möjligt att på ett enkelt sätt detektera en avstàndsskillnad mellan det andra föremålet 140 och omgivningen på ett sådant sätt att syftlinjen 120 kan detekteras. Således kan också t.ex. en vertikal kant fungera som andra föremål 140.In addition, a second object 140 is used, preferably in the form of a vertical bar. It is also conceivable that the second object 140 is e.g. a large plate with a vertical hole in it. The important thing in this context is to have a second object 140 which makes it possible to easily detect a distance difference between the second object 140 and the surroundings in such a way that the line of sight 120 can be detected . Thus, e.g. a vertical edge acts as other objects 140.

Förfarandet för kalibrering av avståndsskannem 111 blir då att placera fordonet 100 så att den kallbrerade ledvinkelsensom 110 indikerar nolläge, steg 320. En punkt eller annan bild 143 genereras med hjälp av spaltlasem 121 och hindret 122 i syftlinjen 120 på samma sätt som beskrivits ovan, steg 330. Bilden 143 . blir då en indikering på var syftlinjen 120 ligger och vilken linje som avståndsskannem 111 ska kalibreras längs. Det andra föremålet 140 placeras i i syftlinjen 120, genom att se till att bilden 143 projiceras på det andra föremålet 10 15 20 533 ??7 14 140, steg 340. Lämpligt kan vara att placera det andra föremålet 140 ca 10-20 m framför fordonet.The method of calibrating the distance scanner 111 then becomes to position the vehicle 100 so that the cold-bred joint angle sensor 110 indicates zero position, step 320. A point or other image 143 is generated by the slit laser 121 and the obstacle 122 in the line of sight 120 in the same manner as described above, step 330. Pictures 143. then becomes an indication of where the aiming line 120 is located and which line the distance scanner 111 is to be calibrated along. The second object 140 is placed in the line of sight 120, by making sure that the image 143 is projected on the second object 1015 20 533 ?? 7 14 140, step 340. It may be convenient to place the second object 140 about 10-20 m in front of the vehicle .

Avståndsskannem 111 mäter sedan avstånd till föremål inom ett område 141.The distance scanner 111 then measures the distance to objects within an area 141.

Om avståndet från avståndsskannem till övriga föremål 142 i närheten av syftlinjen 120 är större än till det andra föremålet 140, så fås en tydlig markering av det andra föremàlets 140 läge i datat från avståndsskannem 111 och avstândsskannerns 111 riktning i förhållande till syftlinjen 120 kan därigenom bestämmas. Detta kan t.ex. göras med hjälp av en offlineanalys, genom att uppmätt laserdata visas på fordonets display eller via en automatisk analys av datat som initieras av operatören. Avstândsskannem 111 kan sedan justeras manuellt eller automatiskt t.ex. genom att ändra dess offset, så att dess nolläge sammanfaller syftlinjen 120, steg 350. Lämpligen kalibreras avståndsskannern 111, så att felet blir mindre än 0,5°, företrädesvis mindre än 0,3°. med Den bakre avståndsskannern 112 kan kalibreras på motsvarande sätt, genom att byta plats på spaltlasem 121 och hindret 122.If the distance from the distance scanner to other objects 142 in the vicinity of the aim line 120 is greater than to the second object 140, then a clear marking of the position of the second object 140 in the data from the distance scanner 111 and the distance of the distance scanner 111 relative to the aim line 120 can be determined. . This can e.g. is done by means of an offline analysis, by showing measured laser data on the vehicle's display or via an automatic analysis of the data initiated by the operator. The distance scanner 111 can then be adjusted manually or automatically, e.g. by changing its offset so that its zero position coincides with the line of sight 120, step 350. Preferably, the distance scanner 111 is calibrated so that the error becomes less than 0.5 °, preferably less than 0.3 °. with The rear distance scanner 112 can be calibrated accordingly, by swapping places on the slit laser 121 and the obstacle 122.

Fördelarna är att det räcker med en person för att genomföra mätningen.The advantages are that one person is enough to carry out the measurement.

Dessutom går kalibrenngen snabbare genom att den kan utföras direkt av operatören, utan offlineanalys av laserdata. Vidare fås en högre precision. Även om beskrivningen ovan enbart har handlat om kalibrering av ledvinkelsensor och avståndsskanner hos självgående gruvfordon, så går uppfinningen naturligtvis också att använda även i andra fordon.In addition, the calibration speed is faster because it can be performed directly by the operator, without over-analysis of laser data. Furthermore, a higher precision is obtained. Although the description above has only been about calibration of the joint angle sensor and distance scanner in self-propelled mining vehicles, the design can of course also be used in other vehicles.

Uppfinningen är naturligtvis inte begränsad till det ovan beskrivna exemplet, utan kan modiñeras inom ramen för de bifogade patentkraven.The invention is of course not limited to the example described above, but can be modified within the scope of the appended claims.

Claims (1)

1. 0 15 20 25 30 533 77? 15 PATENTKRAV 1) Förfarande för kalibrering av en ledvinkelsensor (110) på ett fordon (100), vilket fordon (100) innefattar ett första parti (100b) med en första centrumlinje (115) och ett andra parti (100a) med en andra centrumlinje (116), vilket första parti (100b) och andra parti (100a) är förbundna med en led (107), vilken led (107) är försedd med en ledvinkelsensor (110) för mätning av en ledvinkel (a) mellan det första partiet (100b) och det andra partiet (100a), kännetecknad av följande steg: 2) Förfarande för (210) placering av fordonet (100) så att ledvinkeln (a) är ungefär 0° och så atten tänkt syftlinje (120) pekar mot ett första föremål (124), vilken tänkt syftlinje passerar mellan en strålalstrande anordning (121) anordnad på det första partiet (100b) på ett avstånd från den första centrumlinjen (115) och ett hinder (122) anordnat på det andra partiet (100a) på samma avstånd från den andra centrumlinjen (116), varvid ledvinkelsensom (110) indikerar en uppmätt ledvinkel; (220) strålning av ett medium från den strålalstrande anordningen (121), så att mediet delvis passerar hindret (122) och mediet delvis stoppas av hindret (122), så att mediet alstrar en bild; (230) projicering av bilden på det första föremålet (124); (240) bestämning av bildens första läge (125) på det första föremålet (124): , (250) förflyttning av fordonet (100) en sträcka mot eller från det första föremålet (124), så att ledvinkelsensom (110) fortsätter att visa väsentligen samma uppmätta ledvinkel; (260) bestämning av bildens andra läge (126) på det första föremålet (124); och (270) justering av ledvinkelsensoms (110) nolläge när ett avstånd mellan bildens första läge (125) och andra läge (126) är större än det avstånd som motsvarar minsta acceptabla fel i ledvinkelmätningen för den utförda förflyttningen. kalibrering av _en ledvinkelsensor enligt krav 1, kännetecknad av att avståndet är noll. 10 15 20 25 30 i. 3) 4) 5) 5) 7) 533 77? 16 Förfarande för kalibrering av en ledvinkelsensor enligt något av kraven 1-2, kännetecknad av att mediet-är något ur gruppen: elektromagnetiska vågor - företrädesvis laser eller radar; ljud - företrädesvis sonar; partiklar - företrädesvis vatten eller färg. Förfarande för kalibrering av en ledvinkelsensor enligt något av kraven 1-3, kännetecknad av kalibrering tills felet i nolläget är mindre än 0,5°, företrädesvis mindre än 0,1”. Förfarande för kalibrering av en avståndsskanner (121, 122) pà ett fordon (100), vilket fordon (100) innefattar ett första parti (100b) och ett andra parti (100a) förbundna med en led (107), vilken led (107) är försedd med en ledvinkelsensor (110) för mätning av en ledvinkel (u) mellan det första partiet (100b) och det andra partiet (100a), kännetecknar! av följande steg: - (310) kalibrering av ledvinkelsensorn (110) enligt något av kraven 1-4;' - (320) placering av fordonet (100) så att ledvinkelsensom (110) indikerar nolläge; _ - (330) alstring av en bild i en syftlinje (120); - (340) projicering av bilden på ett andra föremål (140); och - (350) justering av avstàndsskannems (121, 122) nolläge, så att det andra föremålet (140) ligger i avstàndsskannems (121 ,122) nolläge. Förfarande för kalibrering av en avståndsskanner enligt krav 5, kännetecknad av kalibrering tills felet i nolläget är mindre än 0,5°, företrädesvis mindre än 0,3°. Fordon innefattande ett första parti (100b) med en första centrumlinje (115) och ett andra parti (100a) med en andra centrumlinje (116), vilket första parti (100b) och andra parti (100a) är förbundna med en led (107), vilken led (107) är försedd med en ledvinkelsensor (110) för mätning av en ledvinkel (u) mellan det första partiet (100b) och det andra partiet (100a), kännetecknat av att fordonet (100) innefattar: en strålalstrande anordning (121) anordnad på det första partiet (100b) på ett avstånd från den första centrumlinjen (115), ett hinder (122) anordnat på det andra partiet (100a) på samma avstånd från den andra centrumlinjen (116), vilken strålalstrande 10 15 20 25 3) 9) 533 77? 17 anordning (121) är anordnad att stråla ett medium, så att mediet delvis passerar hindret (122) och delvis stoppas av hindret (122), så att en bild alstras; en anordning för placeringav fordonet (100) så att Iedvinkein (o) är ungefär 0° och så att en tänkt syftlinje (120) mellan den strålalstrande anordningen (121) och hindret (122) pekar mot ett första föremål (124), varvid ledvinkelsensom (110) är anordnad att indikera en uppmätt ledvinkel; en anordning (121, 122) för projicering av bilden på det första föremålet (124) i ett första läge (125); en anordning för förflyttning av fordonet (100) en sträcka mot eller från det första föremålet (124), så att ledvinkelsensom (110) fortsätter att visa samma uppmätta ledvinkel; en anordning (121, 122) för projicering av bilden på det första föremålet (124) i ett andra läge (126); och en anordning för justering av ledvinkelsensorns-(MO) nolläge om ett avstånd mellan bildens första läge (125) och andra läge (126) är större än det avstånd som motsvararminsta acceptabla fel i ledvinkelmätningen för den utförda förflyttningen. Fordon enligt krav 7, kännetecknat av att avståndet är noll Fordon enligt krav 7 eller 8, kännetecknat av att mediet är något ur gruppen: elektromagnetiska vågor - företrädesvis radar eller laser; ljud - företrädesvis sonar; partiklar - företrädesvis vatten eller färg. 10)Fordon enligt något av kraven 7-9, kännetecknat av att hindret (122) är en platta med ett hål (123). 11)Fordon enligt något av kra-ven 7-10, kännetecknat av att det första föremålet (124) är en skärm känslig för mediet. 12)Fordon enligt något av kraven 7-11, kännetecknat av att fordonet är anordnat att kalibrera tills felet i nolläget är mindre än 0,5°, företrädesvis mindre än 0,1 . 13)Fordon (100) enligt något av kraven 7-11, kännetecknat av att fordonet vidare innefattar en anordning för placering av fordonet (100) så att ledvinkelsensorn (1 10) indikerar nolläge; en anordning (121, 122) för alstring 10 533 777 18 av en bild i en syftlinje (120), vilken bildlkan projiceras på ett andra föremål (140); och en anordning för justera avståndsskannerns (111, 112) nolläge, så att det andra föremålet (140) ligger i avståndsskannems (111,112) nolläge. 14)Fordon enligt krav 13, kännetecknad av att fordonet är anordnat att kalibrera avståndsskannem (111, 112) tills felet i nolläget är mindre än O,5°, företrädesvis mindre än 0,3”. 15)Fordon 13-14, avståndsskannern (121) är något ur gruppen laser, radar och sonar. enligt något av kraven kännetecknad av att 16)Fordon enligt något av kraven 7-15, kännetecknad av att fordonet är ett gruv- och/eller anläggningsfordon. 17)Fordon enligt något av kraven 7-16, kännetecknad av att fordonet är ett självgående fordon.1. 0 15 20 25 30 533 77? A method for calibrating a hinge angle sensor (110) on a vehicle (100), said vehicle (100) comprising a first portion (100b) having a first centerline (115) and a second portion (100a) having a second centerline (116), which first portion (100b) and second portion (100a) are connected to a hinge (107), which hinge (107) is provided with a hinge angle sensor (110) for measuring a hinge angle (a) between the first portion (100b) and the second portion (100a), characterized by the following steps: 2) Method for (210) positioning the vehicle (100) so that the articulation angle (a) is approximately 0 ° and so that the intended line of sight (120) points towards a first object (124), which intended line of sight passes between a beam generating device (121) arranged on the first portion (100b) at a distance from the first center line (115) and an obstacle (122) arranged on the second portion (100a) on the same distance from the second center line (116), the articulation angle sensor (110) indicating a measured articulation angle; (220) irradiating a medium from the beam generating device (121) so that the medium partially passes the obstacle (122) and the medium is partially stopped by the obstacle (122) so that the medium produces an image; (230) projecting the image on the first object (124); (240) determining the first position (125) of the image on the first object (124):, (250) for fl moving the vehicle (100) a distance towards or from the first object (124), so that the articulation angle sensor (110) continues to show essentially the same measured joint angle; (260) determining the second position (126) of the image on the first object (124); ; calibration of a hinge angle sensor according to claim 1, characterized in that the distance is zero. 10 15 20 25 30 i. 3) 4) 5) 5) 7) 533 77? Method for calibrating a hinge angle sensor according to any one of claims 1-2, characterized in that the medium is one of the group: electromagnetic waves - preferably laser or radar; sound - preferably sonar; particles - preferably water or paint. Method for calibrating a hinge angle sensor according to any one of claims 1-3, characterized by calibration until the error in the zero position is less than 0.5 °, preferably less than 0.1 ". A method for calibrating a distance scanner (121, 122) on a vehicle (100), the vehicle (100) comprising a first portion (100b) and a second portion (100a) connected to a joint (107), which joint (107) is provided with a hinge angle sensor (110) for measuring a hinge angle (u) between the first portion (100b) and the second portion (100a), characterized! of the following steps: - (310) calibration of the hinge angle sensor (110) according to any one of claims 1-4; - (320) positioning the vehicle (100) so that the articulation angle sensor (110) indicates zero position; _ - (330) generating an image in a line of sight (120); - (340) projecting the image onto a second object (140); and - (350) adjusting the zero position of the distance scanner (121, 122) so that the second object (140) is in the zero position of the distance scanner (121, 122). Method for calibrating a distance scanner according to claim 5, characterized by calibration until the error in the zero position is less than 0.5 °, preferably less than 0.3 °. Vehicles comprising a first portion (100b) having a first centerline (115) and a second portion (100a) having a second centerline (116), said first portion (100b) and second portion (100a) being connected to a joint (107) , which joint (107) is provided with a joint angle sensor (110) for measuring a joint angle (u) between the first portion (100b) and the second portion (100a), characterized in that the vehicle (100) comprises: a beam generating device ( 121) arranged on the first portion (100b) at a distance from the first center line (115), an obstacle (122) arranged on the second portion (100a) at the same distance from the second center line (116), which beam generating 25 3) 9) 533 77? Device (121) is arranged to radiate a medium, so that the medium partly passes the obstacle (122) and is partially stopped by the obstacle (122), so that an image is generated; a device for positioning the vehicle (100) so that the angle (0) is approximately 0 ° and such that an imaginary line of sight (120) between the beam generating device (121) and the obstacle (122) points towards a first object (124), the articulation angle being (110) is arranged to indicate a measured joint angle; a device (121, 122) for projecting the image of the first object (124) into a first position (125); a means for moving the vehicle (100) a distance towards or from the first object (124), so that the articulation angle sensor (110) continues to show the same measured articulation angle; a device (121, 122) for projecting the image of the first object (124) into a second position (126); and a device for adjusting the articulation angle sensor (MO) zero position if a distance between the first position (125) of the image and the second position (126) is greater than the distance corresponding to the least acceptable error in the articulation angle measurement for the performed movement. Vehicle according to claim 7, characterized in that the distance is zero. Vehicle according to claim 7 or 8, characterized in that the medium is something from the group: electromagnetic waves - preferably radar or laser; sound - preferably sonar; particles - preferably water or paint. Vehicle according to one of Claims 7 to 9, characterized in that the obstacle (122) is a plate with a hole (123). Vehicle according to one of Claims 7 to 10, characterized in that the first object (124) is a screen sensitive to the medium. Vehicle according to one of Claims 7 to 11, characterized in that the vehicle is arranged to calibrate until the error in the zero position is less than 0.5 °, preferably less than 0.1. Vehicle (100) according to one of Claims 7 to 11, characterized in that the vehicle further comprises a device for positioning the vehicle (100) so that the articulation angle sensor (1 10) indicates a zero position; a device (121, 122) for generating an image in a line of sight (120), the image being projected onto a second object (140); and a device for adjusting the zero position of the distance scanner (111, 112) so that the second object (140) is in the zero position of the distance scanner (111, 112). Vehicle according to claim 13, characterized in that the vehicle is arranged to calibrate the distance scanner (111, 112) until the error in the zero position is less than 0.5 °, preferably less than 0.3 '. 15) Vehicle 13-14, the distance scanner (121) is something from the group of lasers, radar and sonar. according to any one of the claims, characterized in that 16) Vehicle according to any one of claims 7-15, characterized in that the vehicle is a mining and / or construction vehicle. Vehicle according to one of Claims 7 to 16, characterized in that the vehicle is a self-propelled vehicle.
SE0950339A 2009-05-14 2009-05-14 Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles SE533777C2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
SE0950339A SE533777C2 (en) 2009-05-14 2009-05-14 Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles
PCT/SE2010/050517 WO2010132014A1 (en) 2009-05-14 2010-05-11 Method for calibrating a hinge angle sensor on a vehicle and a vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
SE0950339A SE533777C2 (en) 2009-05-14 2009-05-14 Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles

Publications (2)

Publication Number Publication Date
SE0950339A1 SE0950339A1 (en) 2010-11-15
SE533777C2 true SE533777C2 (en) 2011-01-11

Family

ID=43085224

Family Applications (1)

Application Number Title Priority Date Filing Date
SE0950339A SE533777C2 (en) 2009-05-14 2009-05-14 Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles

Country Status (2)

Country Link
SE (1) SE533777C2 (en)
WO (1) WO2010132014A1 (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9969283B2 (en) 2013-09-10 2018-05-15 General Electric Company Battery changing system and method
CN109633575B (en) * 2018-10-26 2020-07-31 上海无线电设备研究所 Three-axis calibration system and method for satellite-borne microwave optical composite radar
RU2742323C2 (en) 2018-12-29 2021-02-04 Общество с ограниченной ответственностью "Яндекс Беспилотные Технологии" Method and computer device for determining angular displacement of radar system
CN111912374A (en) * 2019-05-08 2020-11-10 中车株洲电力机车研究所有限公司 Vehicle articulation angle measuring system and method and application vehicle
CN110308724B (en) * 2019-07-01 2022-06-03 阿波罗智能技术(北京)有限公司 Automatic driving control method, automatic driving control device, vehicle, storage medium and electronic equipment
CN113320566B (en) * 2020-02-28 2023-04-07 长沙智能驾驶研究院有限公司 Multi-train hinge angle zero calibration method and device and computer equipment
EP4303102A1 (en) * 2022-07-07 2024-01-10 Sandvik Mining and Construction Oy Non-cabin articulated truck

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE69108639T2 (en) * 1990-08-16 1995-11-30 Eaton Corp Articulation angle sensor calibration system and method for tractor-trailer combinations.
US6900724B2 (en) * 2003-09-16 2005-05-31 Bandwidth Design, Inc. Virtual electronic back-up alignment apparatus
US7715953B2 (en) * 2003-04-25 2010-05-11 Glimpse Waters, Inc. Trailer backing up device and method
US6956468B2 (en) * 2003-05-09 2005-10-18 General Motors Corporation Sensing mechanism for hitch articulation angle
US7396035B1 (en) * 2003-11-05 2008-07-08 Smith Rick L Trailer hitch alignment device

Also Published As

Publication number Publication date
SE0950339A1 (en) 2010-11-15
WO2010132014A1 (en) 2010-11-18

Similar Documents

Publication Publication Date Title
SE533777C2 (en) Method for calibrating a tilt angle sensor on a vehicle, method for calibrating a distance scanner on a vehicle and vehicles
SE532431C2 (en) Method and apparatus for determining a correspondence between a representation of an environment and said environment
Rose et al. An integrated vehicle navigation system utilizing lane-detection and lateral position estimation systems in difficult environments for GPS
US20150168136A1 (en) Estimating three-dimensional position and orientation of articulated machine using one or more image-capturing devices and one or more markers
CN107560612A (en) For the system and method for the Angle Position for determining the vehicles
CN106560347A (en) Parking Obstruction Locator And Height Estimator
JP5105596B2 (en) Travel route determination map creation device and travel route determination map creation method for autonomous mobile body
CN104380137A (en) Method and handheld distance measurement device for indirect distance measurement by means of image-assisted angle determination function
CN103328926A (en) Measuring appliance comprising an automatic representation-changing functionality
JP7352556B2 (en) Method for commanding a set of one or more intervention tools mounted on a railway intervention vehicle
AU2009213057A1 (en) Machine sensor calibration system
US11514681B2 (en) System and method to facilitate calibration of sensors in a vehicle
JP4596566B2 (en) Self-vehicle information recognition device and self-vehicle information recognition method
DE102009045326A1 (en) Method for designing database for determining position of vehicle by navigation system, involves storing determined landmarks and associated actual position at time point of recording of images during reaching danger point
JP4436632B2 (en) Survey system with position error correction function
JP7138538B2 (en) Laser scanner calibration method, material handling machine
JP3940619B2 (en) Tunnel excavator position measuring device
CN110132280B (en) Vehicle positioning method and device in indoor scene and vehicle
SE532430C2 (en) Method and apparatus for determining the reliability of an estimated position for a mining and / or construction machine
KR101894204B1 (en) Realtime container truck monitoring method and system
JP6500385B2 (en) Moving amount estimation device, autonomous moving body, and moving amount estimation method
JP3759281B2 (en) Underground excavator position measurement device
JP3247143B2 (en) Positioning / posture surveying device for moving objects
JPWO2019154720A5 (en)
US20230098171A1 (en) Marking apparatus, control method for marking apparatus, and storage medium

Legal Events

Date Code Title Description
NUG Patent has lapsed