[go: up one dir, main page]

SE536649C2 - System och metod för reglering av fordon i fordonståg - Google Patents

System och metod för reglering av fordon i fordonståg Download PDF

Info

Publication number
SE536649C2
SE536649C2 SE1250629A SE1250629A SE536649C2 SE 536649 C2 SE536649 C2 SE 536649C2 SE 1250629 A SE1250629 A SE 1250629A SE 1250629 A SE1250629 A SE 1250629A SE 536649 C2 SE536649 C2 SE 536649C2
Authority
SE
Sweden
Prior art keywords
vehicle
data
train
vehicles
vehicle train
Prior art date
Application number
SE1250629A
Other languages
English (en)
Other versions
SE1250629A1 (sv
Inventor
Josefin Kemppainen
Sanna Nilsson
Hanna Pettersson
Assad Al Alam
Henrik Pettersson
Original Assignee
Scania Cv 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 Scania Cv Ab filed Critical Scania Cv Ab
Priority to SE1250629A priority Critical patent/SE536649C2/sv
Priority to EP13803923.5A priority patent/EP2862158B1/en
Priority to PCT/SE2013/050672 priority patent/WO2013187834A1/en
Publication of SE1250629A1 publication Critical patent/SE1250629A1/sv
Publication of SE536649C2 publication Critical patent/SE536649C2/sv

Links

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/22Platooning, i.e. convoy of communicating vehicles
    • 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/14Adaptive cruise control
    • B60W30/16Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L23/00Control, warning or like safety means along the route or between vehicles or trains
    • B61L23/34Control, warning or like safety means along the route or between vehicles or trains for indicating the distance between vehicles or trains by the transmission of signals therebetween
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0291Fleet control
    • G05D1/0293Convoy travelling
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L2205/00Communication or navigation systems for railway traffic
    • B61L2205/04Satellite based navigation systems, e.g. global positioning system [GPS]
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L25/00Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
    • B61L25/02Indicating or recording positions or identities of vehicles or trains
    • B61L25/025Absolute localisation, e.g. providing geodetic coordinates
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Transportation (AREA)
  • Train Traffic Observation, Control, And Security (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Description

536 649 sikt till målet vilket gör det svårt att detektera händelser mer än ett par fordon framåt i kön.
En ytterligare begränsning är att de inte kan reagera proaktivt, d.v.s. reagera på händelser som inte hafi någon markant påverkan på trafikrytmen.
En utvecklig av IEEE-standarden 802.11 fór WLAN (Wireless Local Area Networks) kallat 802.11p möjliggör trådlös överföring av information mellan fordon, och mellan fordon och infrastruktur. Olika sorters information kan sändas till och från fordonen, såsom fordonspararnetrar och strategier. Ett framfórvarande fordon i fordonståget kan då exempelvis: 0 Sända information om det egna fordonets tillstånd, d.v.s. vikt, hastighet, motoreffekt, position etc. 0 Sända infonnation om åtgärder som påverkar omgivande trafik, exempelvis vid bromsning. 0 Agera prob fór bakomvarande fordon genom att trafikhändelser bakåt i fordonståget. rapportera iakttagna Inforrnationstillgången möjliggör skapandet av nya funktioner fór att exempelvis assistera föraren att köra på ett mer effektivt och säkert sätt. Utvecklingen av kommunikationstekniken har gjort det möjligt att utforma lastbilar och infrastruktur som stöder användandet av fordonståg. Fordonståget kan agera som en enhet vilket medför dämpning av svängningar i tåget orsakade av hastighetsändringar. Följaktligen möjliggörs kortare avstånd och ett bättre globalt trafikflöde.
Skapandet av fordonståg ger dock upphov till nya problemställningar. I dagsläget är inte alla fordon utrustade för trådlös kommunikation och detta kan leda till att fordon utan möjlighet att kommunicera trådlöst kommer in i fordonståget. Detta kan bidra till problem vid regleringen av fordonen i fordonståget då all nödvändig information inte finns tillgänglig.
I ”String-stable CACC design and experimental validation”, R.P.A. Vugts, Master”s Thesis, Technische Universitet Eindhoven, Department of Mechanical Engineering, Control Systems Technology Group, beskrivs problemet med att ett eller flera okända 10 15 20 25 30 536 649 fordon kommer in i fordonståget. Dock omfattar examensarbetet inte dessa fall, utan avgränsar sig till fallet när kommunikation är möjlig med ett direkt framförvarande fordon.
I WO-2012/020297-Al beskrivs en styranordning samt styrmetod för reglering av fordon.
Då ett fordon kommer in mellan ett värdfordon och ett framförvarande fordon blir tiden mellan värdfordonet och det framförvarande fordonet större än den förbestämda tiden.
Radar används då för att detektera fordonet, och sätter en tid mellan fordonen baserat på resultatet av detektionen.
För att ett fordonståg ska fungera på ett bra sätt måste de andra fordonens hastighet erhållas via trådlös kommunikation. När ett fordon utan möjlighet att kommunicera trådlöst kommer in i fordonståget, går det inte att trådlöst få information om dess hastighet. Åtgärder måste då vidtagas för att säkerställa korrekt reglering av fordonen.
Syftet med uppfinningen är således att tillhandahålla ett förbättrat system som underlättar regleringen av fordon då det finns fordon som kommunicera på olika sätt.
Sammanfattning av uppfinningen Enligt en aspekt uppnås åtminstone delvis det ovan beskrivna syftet genom ett system för att reglera fordon i ett fordonståg enligt det första oberoende kravet. Fordonståget innefattar ett ledarfordon och åtminstone ett ytterligare fordon anpassade att kommunicera via trådlös kommunikation. Systemet innefattar vidare en processorenhet som är anpassad att ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget, varvid datan innefattar identifieringsdata som indikerar från vilket fordon nämnda data kommer ifrån. Processorenheten är anpassad att analysera nämnda data enligt förutbestämda kriterier som innefattar att jämföra identifieringsdata från mottagen data med identifieringsdata för fordonståget och fusionera emottagen identifierbar data för att estimera ett eller flera fordonstillstånd för fordonet.
Processorenheten är vidare anpassad att kategorisera nämnda fordon i en av ett förutbestämt antal kategorier baserat på resultatet av nämnda analys, varvid varje kategori innefattar åtminstone trådlöst sändande fordon i fordonståget och trådlöst sändande fordon 10 15 20 25 30 536 649 utanför fordonståget och varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen. processorenheten är vidare anpassad att generera åtminstone en styrsignal som indikerar hur ett eller flera fordon i fordonståget ska regleras baserat på nämnda kategorisering och fordonstillstånd.
Processorenheten är sedan anpassad att sända styrsignalen till en eller flera styrenheter i ett eller flera fordon i fordonståget, varvid fordonen regleras i enlighet därmed.
Genom uppfinningen underlättas regleringen av fordon i ett fordonståg. Infonnationen om vilken kategori fordon tillhör kan användas av en regulator, som direkt kan anpassa sin beräkning av styrparametrar för ett fordon i fordonståget i enlighet med hur omgivande fordon kategoriserats. Uppfinningen underlättar fór regleringen att hela tiden hålla ett säkert avstånd till fordonet framför oavsett om det är ett okänt eller känt fordon. Då man hela tiden håller det kortast möjliga avstånd till framförvarande fordon erhålls både en säker reglering och minskad bränsleförbrukning.
Enligt en andra aspekt uppnås det ovan beskrivna syftet åtminstone delvis genom en metod för att reglera fordon i ett fordonståg, varvid fordonståget innefattar ett ledarfordon och åtminstone ett ytterligare fordon anpassade att kommunicera via trådlös kommunikation. Metoden innefattar stegen att i) ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget varvid datan innefattar identifieringsdata som indikerar från vilket fordon nämnda data kommer ifrån; ii) analysera nämnda data enligt förutbestämda kriterier som innefattar att jämföra identifieringsdata från mottagen data med identifieringsdata för fordonståget och fusionera emottagen identifierbar data för att estimera ett eller flera fordonstillstånd för fordonet ; iii) kategorisera nämnda fordon i en av ett fórutbestämt antal kategorier baserat på resultatet av nämnda analys, varvid kategoriema innefattar åtminstone trådlöst sändande fordon i fordonståget och trådlöst sändande fordon utanför fordonståget och varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen; iv) generera åtminstone en styrsignal som indikerar hur ett eller flera fordon i fordonståget ska regleras baserat på nämnda kategorisering och fordonstillsånd; och att v) reglera åtminstone ett fordon i fordonståget baserat på nämnda kategorisering. 10 15 20 25 30 536 649 Enligt en tredje aspekt uppnås åtminstone delvis det ovan beskrivna syftet genom en datorprogramprodukt, innefattande datorprograminstruktioner för att förmå ett datorsystem att utföra stegen enligt den beskrivna metoden ovan och enligt metodstegen i den detaljerade beskrivningen, datorprograminstruktionerna körs på datorsystemet.
Föredragna utföringsforrner beskrivs i de beroende kraven och i den detaljerade beskrivningen.
Kort beskrivning av de bifogade figurema Nedan kommer uppfinningen att beskrivas med hänvisning till de bifogade figurema, av vilka: Figur 1 visar en översiktsbild av en häri använd fordonsnotation för ett fordonståg.
Figur 2 visar ett blockschema över systemet fór reglering av fordon i ett fordonståg enligt en utföringsform av uppfinningen.
Figur 3 visar ett blockschema över systemet för reglering av fordon i ett fordonståg enligt en annan utföringsforrn av uppfinningen.
Figur 4A och 4B illustrerar hur ett okänt fordon kan kategoriseras enligt en utföringsforrn av uppfinningen.
Figur 5 visar en översiktbild över hur centraliserad styrning fungerar.
Figur 6 visar en översiktbild över hur decentraliserad styrning fungerar.
Figur 7 illustrerar en översiktbild av en metod för att reglera fordon i ett fordonståg enligt en utföringsfonn av uppfinningen.
Detaljerad beskrivning av föredragna utföringsfornier av uppfinningen Ett fordonståg definieras som ett antal fordon som fungerar som en enhet. Varje fordon som tillhör fordonståget styrs automatisk i den longitudinella riktningen och kommunicerar med varandra genom ett trådlöst nätverk. Figur 1 visar en översiktsbild av en häri använd fordonsnotation för ett fordonståg. Det egna fordonet har notationen 1 och de framförvarade fordonen notationen 2,...N. Det egna fordonet kan även refereras till som EGO och fordonet N som ledarfordonet. Dessa notationer är lokala för vardera fordon i fordonståget. Det relativa avståndet och hastigheten mellan fordon 1 och fordon 2 10 15 20 25 30 536 649 refereras till som du, 111,2 etc. Fordonet 1 har hastigheten v; etc. Det generella målet for fordonståg är att hålla fordonen i fordonståget så nära varandra som möjligt genom att reglera fordonens farthållare och bromssystem, för att dra fördel av positiva effekter såsom minskat lufimotstånd.
Genom fordon-till-fordon kommunikation (V2V communication), kan information erhållas trådlöst från de omgivande fordonen. Fordonen innefattar då enheter som är anpassade att trådlöst mottaga och sända information. Ett ytterligare sätt att kommunicera är via fordon-till-infrastruktur-kommunikation (V21 Communication), varvid fordon kan utbyta information trådlöst med exempelvis vägsidesenheter med inbyggd intelligens.
I Figur 2 visas ett blockschema över systemet för reglering av fordon i ett fordonståg enligt en utföringsform av uppfinningen. Systemet innefattar en processorenhet som exempelvis kan vara placerad i ett fordon i fordonståget, alternativt i en externt placerad enhet. Enligt en utföringsform innefattar varje fordon i fordonståget en processorenhet enligt uppfinningen. Underförstått innefattar systemet även minnesutrymme kopplat till processorenheten fór instruktioner. att exempelvis lagra nödvändig data och Processorenheten innefattar även en eller flera processorer som kan exekvera maskinkod.
Processorenheten är anpassad att ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget. Med ett område kring fordonet menas ett område i storleken 0 till 2 km. Den trådlösa kommunikationen har en räckvidd på upp till ca 2 km, och exempelvis radar har en räckvidd på mellan 50-200 m. Ifall processorenheten är placerad i ett fordon, kan data inhämtas exempelvis via ett nätverk i fordonet. Ett vanligt nätverk som används i fordon är CAN (Controller Area Network). Data på nätverket kommer från data som sänts trådlöst från andra fordon, och från sensorer i det egna fordonet. Fordonen i fordonståget är vanligtvis utrustat med ett flertal detektorer som tillhandahåller fordonsparametrar som exempelvis fordonens position och/eller hastighet. Radar, lidar eller en kameraenhet kan exempelvis ge information om det relativa avståndet, den relativa hastigheten och/eller accelerationen mellan fordonen. Fordonen innefattar då åtminstone en radarenhet, lidarenhet och/eller kameraenhet vardera. Global Positioning System (GPS) är ett 10 15 20 25 30 536 649 satellitnavigationssystem som ger fordonets position i longitud- och latitudkoordinater samt hastigheten till en GPS-mottagare i fordonet. Varje fordon i fordonståget har företrädesvis en GPS-enhet. Information från GPS-enheten kan sedan distribueras till olika system i fordonet via exempelvis CAN, och till andra fordon via trådlös kommunikation.
Information såsom motoms vridmoment, fordonsmassa, odometerdata, riktning och/eller girhastighet kan vanligtvis även läsas från CAN. Inforrnation från CAN avläses enligt en utföringsfonn med en frekvens på 100 Hz.
Data som överförts trådlöst till fordonet innehåller förutom fordonsparametrar även identifieringsdata som indikerar från vilket eller vilka fordon fordonsparametrama kommer ifrån. Processorenheten är företrädesvis anpassad att kontrollera och hålla reda på från vilket fordon data kommer genom nämnda identifieringsdata. Den trådlösa datan illustreras i Figur 2 som trådlösa signaler genom de streckade linjema som mottages till processenheten. Signalerna innefattar datapaket med tillhörande identifiering som anger från vilket fordon datapaketet härstammar. Signalema mottages i fordonen med en frekvens av exempelvis 10 Hz. Enligt en utföringsform har varje fordon ett specifikt ID- nummer direkt kopplat till fordonet som anges som identifiering av ett datapaket. Varje fordon som ingår i ett fordonståg får enligt en utföringsfrom också ett specifikt fordonstågs-ID, som exempelvis kan vara ID-numret på ledarfordonet i fordonståget.
Processorenheten är vidare anpassad att analysera nämnda data enligt förutbestämda kriterier. Detta kan ske genom exempelvis estimering och/eller sensorfusion, som kommer att förklaras i det följande. Baserat på resultatet av analysen, kategoriseras sedan fordonet i en av ett förutbestämt antal kategorier, varvid varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen. Enligt en utföringsform innefattar de förutbestämda kategoriema 1) trådlöst sändande fordon i fordonståget och/eller 2) trådlöst sändande fordon utanför fordonståget och/eller 3) okänt fordon i fordonståget. Enligt en utföringsfonn anger nämnda regler för en kategori hur ett fordon placerat efter ett fordon i denna kategori ska regleras. Ifall ett fordon har placerats i kategori 3), så ska fordonet efter det i fordonståget enligt en utföringsform öka avståndet till detta fordon för att en säker reglering ska kunna erhållas. Även andra kategorier än de ovan beskrivna är naturligtvis tänkbara. 10 15 20 25 30 536 649 I Figur 3 visas en översiktsbild av ett system för reglering av fordonen i ett fordonståg enligt en utföringsform av uppfinningen. Processenheten innefattar enligt denna utföringsforrn tre funktionsenheter som kommer att förklaras i det följande. Denna strategi ska enbart ses som ett exempel, och andra strategier är tillämpbara i samband med uppfinningen. Den första enheten, “EST.”-enheten, tar emot data från exempelvis ett nätverk i fordonet. Enligt en utföringsforrn innefattar alltså nämnda data identifieringsdata som indikerar från vilket fordon nämnda data kommer ifrån. Processorenheten kan då vara anpassad att analysera datat från ett fordon genom att jämföra identifieringsdata från mottagen data med identifieringsdata fór fordonståget. Baserat på resultatet av jämförelsen, kategoriseras sedan fordonet i en av ett förutbestämt antal kategorier. Ifall identifieringsdata från mottagen data matchar identifieringsdata från fordonståget, kommer det mottagna datat fi'ån ett trådlöst sändande fordon i fordonståget. Fordonet kategoriseras då i kategorin 1), d.v.s. trådlöst sändande fordon i fordonståget. På så sätt kan regulatorn enkelt få reda på vilka fordon som ingår i fordonståget. Ifall identifieringsdata från mottagen data ing matchar identifieringsdata från fordonståget, kommer det mottagna datat från ett trådlöst sändande fordon utanför fordonståget.
Fordonet kategoriseras då i kategorin 2), d.v.s. trådlöst sändande fordon utanför fordonståget. Denna kategori är av intresse att hålla reda på eftersom ett sådant fordon kanske kommer att vilja ingå i fordonståget, och då vet redan systemet och regulatorn hur denne ska regleras. Enligt en utföringsform estimeras även tillstånd för ett eller flera fordon i EST.-enheten, samt beräknas kontrollvärden för respektive tillstånd. Denna estimering och beräkning av kontrollvärden kan exempelvis göras med ett utökat Kalmanfilter, som beskrivs i det följande. Sensordata från kända källor taggade med identifieringsdata fusioneras för att estimera exempelvis fordonstillstånden position, hastighet och riktning för fordonen. EST.-enheten mottager alltså avkänd rådata och garanterar bland armat att datat är relevant för vidare estimeringar före det går in i de två följande enhetema. Processorenheten är alltså anpassad att kategoriera fordon åtminstone delvis beroende på med vilken metod nämnda data tagits fram, exempelvis om den mottagits trådlöst eller inte. 10 15 20 25 30 536 649 I “FUSION”-enheten som visas i Figur 3 fiasioneras sedan sensorvärden som är identiferbara genom märkning, exempelvis trådlös data innefattande identifieringsdata, med sensordata som är omärkt, exempelvis data från radar, lidar eller kamera. I fusionen ingår estimering av tillstånd, som enligt en utfóringsfonn är position, hastighet och/eller längd fór de fordonen i fordonståget som hänsyn ska tas vid regleringen. En ID-vektor för alla fordonen som bestäms ska estimeras återkopplas enligt en utfóringsforrri till EST.- enheten, vilket visas som “ID” i Figur 3. ID-vektom innefattar identiteten fór de fordon som bestämts ska estimeras. Fusionen kan exempelvis utföras med ett utökat Kalmanfilter (EKF), som beskrivs hämäst.
Utökat Kalmanfilter EKF är ett filter som kan hantera olinjäriteter i modellerna. Vid filtreringen utförs ett prediktionssteg även kallat tidsuppdatering baserat på en fysisk modell (l) av fordonet, den föregående informationen om tillständen samt samplingstiden. Fordonsmodellen (1), som visas som ett exempel, uttrycker fordonet i:s acceleration enligt följande: a_ _ få (ififnmf T __ ÛdAaPaVZ + CdAaPaVZ _ fi(d) _ ' /mmråflfijëvhnfje ra, e 2 2 100 crmycoszz-mgsina/ (1) i vilken TW är fordonets hjulradie, ja, är fordonets hjultröghet, m är fordonets massa, it är fordonets överföringsförhållande gällande växel, if är fordonets överfóringsfórhållande för slutväxeln, nt är en verkningskonstant fór gällande växel, nf är en verkningskonstant for slutväxeln, je är motoms tröghetsmoment, Te är motormomentet, cd är luftdragskoefficienten, Aa är fordonets frontarea, pa är luftdensiteten, v är fordonets hastighet, fi-(d) är en funktion för fordonet i:s minskning av luftdragskoefficienten, c, är fordonets rullkoefficient, g är gravitationskonstanten och a är vägens lutning. Modellen diskretiseras sedan för att kunna användas i estimeringen. Vid beskrivningen av EKF nedan används for enkelhetens skull en generell modell (2) fór fordonets rörelse, vilken alltså kan motsvaras av en diskretiserad variant av modellen (l). 10 15 20 25 30 536 649 En generell modell av en olinjär rörelsemodell i diskret tid illustreras genom (2) nedan: ík+1 = f(2k| uk I 6! Uk) i vilken ik är den estimerade tillståndvektorn, uk är insignaler, 6 är modellparametrar samt vk är processbrus. Vid tidsuppdateringen predikteras tillstånden (3) samt den tillhörande kovariansen (4) enligt: fIqk-1 = f(fk-1|k-1»uk-1-9'Vk-1) (3) Pk|1<-1 = FkplqkFkT + Qk (4) ivilken _ af Fk-l _ ä; ifk_1|k,'llk_1 Qk är kovariansmatrisen för vk. Alltså, Qk beskriver modellens osäkerhet och kan viktas efier hur väl modellen motsvarar verkligheten.
I ett nästa steg jämförs de predikterade tillstånden med uppmätta värden för tillstånden.
Detta steg kallas även mätuppdatering. För att kunna jämföra de uppmätta värdena med de predikterade värdena används en modell för mätvärdena enligt (6) nedan: yk = h(fk| uk! 61 ek) i vilken yk är de nu förprocessade mätvärdena i vektorformat och ek är mätbruset. Vid mätuppdateringen jämförs sedan de förprocessade mätvärdena med den estimerade tillståndvektorn från tidsuppdateringen enligt (7) nedan: Ek = Yk _ hÜkuc-i) (7) Kovariansen Sk för mätvärdesresidualen sk beräknas enligt (8) 10 10 15 20 25 30 536 649 Sk = Hkpkuc-iHif + Rk (8) i vilken Pk är kovariansen fór tillstånden och H k beräknas enligt (9): Hk = 2-2 LW. <9) Rk är kovariansmatrisen fór mätbruset, ek. Rk är den motsvarande viktmatrisen till Qk och kan justeras efter osäkerheten i sensormätvärdena. Därefter beräknas den estimerade tillståndsuppdateringen, 58k, enligt (10): flak = fiqk-i + Kkfk (10) i vilken Kalmanförstärkningen, K, är Kk = pkm-iHlïsk-l (11) Kovariansmatrisen P fór de estimerade tillstånden uppdateras sedan enligt (12) nedan: Plqk = (1- KkHIÖPIqk-i (12) Insignalema till filtret som används i FUSIONS-enheten är vektom (13) enligt nedan: uk=lTe alT (13) i vilken Te (fordonets motormoment), çb (fordonets riktning) och a, vägens lutning, erhålls från data via trådlös kommunikation.
Mätningarna kommer alltså från två olika källor. Den första källan är EST.-enheten som ger en estimerad position zp och hastighet zu fór varje fordon baserat på exempelvis sensormätningar från det egna fordonet och trådlös data. Den andra källan är här radar, 11 10 15 20 25 30 536 649 fiån vilken ett relativt avstånd zprel samt en relativ hastighet zum till fordonet framför erhålls. Mätsignalerna till filtret är vektorn (14) kan då uttryckas enligt nedan: Zk = [ZP Zv Zpfez zvrezlT (14) Beräkningama i EKF kan sedan göras antingen utifrån ett globalt referenssystem som innefattar alla fordonen i fordonståget och som använder GPS-koordinater i form av longitud och latitud fór att beskriva fordonens position, eller ett lokalt referenssystem som erhåller genom koordinattransforrnation av det globala koordinatsystemet. I det lokala referenssystemet är det egna fordonet EGO origo. Beroende på vilket referenssystem som används, kan mätekvationer hä) för respektive z-parameter uttryckas, som sedan används i filtreringen.
Vid estimeringen i FUSIONS-enheten är det möjligt att estimera exempelvis fordonets längd, vilket kan vara användbar data för många applikationer. Då lastbilars längd ofia ändras beroende på hur många och långa släp det har, underlättar det ifall man kan beräkna längden istället för att bestämma den i förväg. Processorenheten är enligt en utföringsfonn anpassad att analysera data genom att estimera fordonets längd l, beräkna en skillnad Al mellan den estimerade längden och en förutbestämd längd på fordonet, samt jämföra Al med ett förutbestämt tröskelvärde. Fordonet kan sedan kategoriseras i en kategori i beroende av resultatet av jämförelsen. Ifall den estimerade längden på fordonet plötsligt ökar, eller åtminstone mer än tröskelvärdet, indikerar detta att ett okänt fordon kommit in i fordonståget. Detta okända fordon kan då kategoriseras i kategorin 3) okänt fordon i fordonståget. Det okända fordonet sänder då inte data trådlöst, och ett system i ett fordon som ska identifiera ett framförvarande fordon via radar och trådlös data kommer att få data härstammande från olika fordon. I Figur 4A och Figur 4B exernplifieras hur ett okänt fordon kan identifieras genom att övervaka det framförvarande fordonet i:s längd.
Fordonen i:s och i-l:s respektive position är kända genom GPS, och det relativa avståndet Ap - GPS kan då räknas ut mellan fordonen. Fordonet i-l mäter det relativa avståndet Apre, genom att använda radar. I FUSION-enheten bestäms ifall mätningarna gäller samma fordon. Fordonet i:s längd l,- kan då bestämmas genom att subtrahera Apre, från Ap 12 10 15 20 25 30 536 649 - GPS, vilket illustreras i Figur 4A. Denna längd antas då som fordonets verkliga längd, och kan alltså bestämmas under färd. Denna nu förutbestämda längd jämförs sedan företrädesvis kontinuerligt med nya beräknade värden för fordonet i:s längd li. En skillnad kan räknas fram, och ifall skillnaden är större än ett förutbestämt tröskelvärde, antas det att ett nytt fordon har kommit in mellan fordonen i och i-l , vilket illustreras i Figur 4B. Detta nya fordon kategoriseras då i kategori 3) som tidigare förklarats. Enligt en utföringsform är det förutbestämda tröskelvärdet mellan 5-50 m.
Processorenheten kan även vara anpassad att beräkna ett eller flera kontrollvärde(n) för nämnda estimerade tillstånd som indikerar hur pålitlig estimeringen av tillståndet eller tillstånden är beroende på hur väl data från olika källor motsvarar varandra. Ifall längden på ett fordon plötsligt ökar, kommer även kontrollvärdet i form av den estimerade längdens varians att öka, vilket indikerar att ett okänt fordon kommit in mellan fordonet i och i-l (se Figur 4B). Ett fordon kan alltså kategoriseras baserat på dess tillstånds varians.
Enligt denna utföringsform är alltså processorenheten anpassad att analysera datat genom att beräkna variansen för fordonets längd li, jämföra variansen med ett förutbestämt tröskelvärde, samt kategorisera fordonet i en kategori i beroende av resultatet av jämförelsen. Denna vetskap kan sedan användas i regleringen av fordonen i fordonståget, för att få en säkrare reglering.
I utföringsformen som visas i Figur 3, erhåller sedan ”REG.”-enheten de relativa avstånden dkkfl mellan de N fordonen, samt hastigheten 12k för respektive fordon i fordonståget från FUSIONS-enheten. Även fordonens kategori förs vidare till REG.- enheten, som sedan anpassar sin reglerstrategi efler kategoriseringen. REG-enheten tar enligt kategoriexemplet som beskrivits ovan hänsyn till de fordon som har kategoriserats i kategori 1) och 3), och anpassar exempelvis fordonens hastighet v och avstånden d mellan fordonen därefter. Processenheten är alltså anpassat att generera åtminstone en styrsignal som indikerar hur fordonen i fordonståget ska regleras baserat på nämnda kategorisering.
Enligt en utföringsform genereras styrsignaler genom att använda en MPC-algoritm, som hämäst kommer att förklaras.
MPC 13 10 15 20 25 536 649 MPC är en utökning av en LQ-regulator, som ofta används fór att lösa multivariabla reglerproblem. LQ-regulatom minimerar en kostnadsfunktion vars funktion beskrivs som en linjär differentialekvation. Den generella kvadratiska kostnadsfunktionen minimeras med avseende på styrsignalen u, exempelvis avståndet d och/eller hastigheten v, enligt (15) nedan: min Zfëollxflüllšl + IIUUOIIÄ (15) i vilken P1 och P2 är viktmatriser och används fór att balansera hur tillstånden och styrsignalen värderas. MPC kan även hantera begränsningar av styrsignalen och tillstånden, och kostnadsfunktion som sedan ska minimeras blir då: 1H,,(x(k)) = zfígluxrk +1)||%1 + ||u i vilken Hp är prediktionshorisonten, och begränsningar av avståndet mellan fordon i fordonståget, fordonens hastighet och/eller motorrnoment. Enligt en utfóringsform introduceras en integrerande verkan i kostnadsfunktionen (13) genom att skillnaden mellan två eflerföljande styrsignaler ska minimeras. Denna utfóringsfonn ger en jämnare reglering eftersom styrsignalen inte tillåts att variera för mycket. Utsignaler från MPC:n är styrsignaler till andra regulatorer i fordonet i fonn av en referenshastighet till farthållaren och/eller en referensretardation till bromssystemet. Regulatom kommer alltså att fungera som en Överordnad regulator över de existerande farthållarna och/eller bromssystemen.
Enligt en utföringsfonn innefattar systemet en omvandlingsenhet (visas inte) som är anpassad att omvandla en styrsignal innefattande moment Te till en lämplig styrsignal för en styrenhet i ett fordon. Detta kan göras enligt följande villkor: Te > -zso, m, = v(1< + 1) (k 1)- (k) Te s -250, am, = (17) (13) 14 10 15 20 25 30 536 649 varvid vref är insignal till en farthållare, och aref är insignal till ett bromssystem. De angivna värdena ska endast ses som exempel, och andra värden är alltså tillämpbara för uppfinningen. Från REG.-enheten skickas nu styrsignaler vidare till en eller flera styrenheter i fordonet eller till styrenheter i andra fordon. Detta beror bland annat på val av reglerstrategi. I Figur 5 visas en översiktbild över hur centraliserad styrning fungerar för N fordon i ett fordonståg. Den omgivande ramen representerar att alla fordonen har information om alla de andra fordonen i fordonståget. Varje fordon löser då samma optimeringsproblem. Det vill säga, varje fordon i fordonståget beräknar en optimal styrsignal för varje fordon i fordonståget. Fusion samt distribution av de optimala styrsignalema behöver då göras för att uppnå en styrsignal som blir den verkliga utsignalen från regulatorn till vardera styrenhet i respektive fordon. I Figur 6 visas en översiktsbild över hur decentraliserad styrning fungerar. Den omgivande ramen representerar att varje fordon har en beskrivning av sitt eget fordonssystem, och att varje fordon utför optimering av dess egna styrsignal(er) och därför kan styrsignalen eller styrsignalema användas direkt efter att den eller de har beräknats.
Uppfinningen hänför sig även till en metod för reglering av fordon i ett fordonståg som innefattar ett ledarfordon och åtminstone ett ytterligare fordon anpassade att kommunicera via trådlös kommunikation. Metoden illustreras genom flödesschemat i Figur 7, och innefattar i ett första steg i) att ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget. Denna data kan exempelvis inhämtas via trådlös kommunikation och/eller sensorsystem som exempelvis GPS i fordonet. I ett andra steg ii) analyseras datat enligt förutbestämda kriterier. Enligt en utföringsforrn innefattar datat identifieringsdata som indikerar från vilket fordon nämnda data kommer ifrån, varvid metoden innefattar att analysera nämnda data från ett fordon genom att jämföra identifieringsdata från mottagen data med identifieringsdata för fordonståget. På så sätt kan man identifiera ifall fordonet tillhör fordonståget eller inte, och ifall fordonet är ett sändande fordon, alltså sänder trådlös data.
I ett tredje steg iii) kategoriseras fordonen i en av ett förutbestämt antal kategorier baserat på resultatet av analysen, varvid varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen. Regeln eller reglema för en kategori anger exempelvis hur ett fordon placerat efter ett fordon i denna kategori ska 15 10 15 536 649 regleras. Enligt en annan utföringsform innefattar steg ii) att analysera datat genom att estimera fordonets längd l, beräkna en skillnad Al mellan den estimerade längden och en förutbestämd längd och jämföra Al med ett förutbestämt tröskelvärde, samt steg iv) att kategorisera fordonet i beroende av resultatet av jämförelsen. I ett fjärde steg iv) regleras åtminstone ett fordon i fordonståget baserat på kategoriseringen.
Uppfinningen hänför sig även till en datorprogramprodukt innefattande datorprograrninstruktioner fór att förmå ett datorsystem att utföra stegen enligt metoden som beskrivits ovan, när datorprograminstruktionerna körs på nämnda datorsystem.
Datorprograminstruktionema är enligt en utföringsfonn lagrade på ett av ett datorsystem läsbart medium.
Den föreliggande uppfinningen är inte begränsad till de ovan beskrivna utföringsforrnerna.
Olika alternativ, modifieringar och ekvivalenter kan användas. Därför begränsar inte de ovan nämnda utföringsformema uppfinningens omfattning, som definieras av de bifogade kraven. 16

Claims (14)

10 15 20 25 30 536 649 Patentkrav
1. System för att reglera fordon i ett fordonståg, varvid fordonståget innefattar ett ledarfordon och åtminstone ett ytterligare fordon anpassade att kommunicera via trådlös kommunikation, varvid systemet innefattar en processorenhet som är anpassad att -ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget, varvid datan innefattar identifieringsdata som indikerar från vilket fordon nämnda data kommer ifrån, k än n et e ck n at av att processorenheten är anpassad att; - analysera nämnda data enligt förutbestämda kriterier som innefattar att jämföra identifieringsdata fiån mottagen data med identifieringsdata för fordonståget och fusionera emottagen identifierbar data för att estimera ett eller flera fordonstillstånd för fordonet; - kategorisera nämnda fordon i en av ett förutbestärnt antal kategorier baserat på resultatet av närrmda analys; varvid kategorierna innefattar åtminstone 1) trådlöst sändande fordon i fordonståget och 2) trådlöst sändande fordon utanför fordonståget och varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen; - generera åtminstone en styrsignal som indikerar hur ett eller flera fordon i fordonståget ska regleras baserat på nänmda kategorisering och fordonstillstånd; - sända nämnda styrsignal till en eller flera styrenheter i ett eller flera fordon i fordonståget, varvid fordonen regleras i enlighet därmed.
2. System enligt krav 1, som innefattar att kategorisera fordon åtminstone delvis beroende på med vilken metod nämnda data tagits fram.
3. System enligt något av ovanstående krav, varvid processorenheten är anpassad att analysera nämnda data genom att estimera fordonets längd l, beräkna en skillnad Al mellan den estimerade längden och en förutbestämd längd, järnföra All med ett iörutbestärnt tröskelvärde, samt kategorisera fordonet i en kategori i beroende av resultatet av jämförelsen. 17 10 15 20 25 30 536 649
4. System enligt något av ovanstående krav, varvid nämnda regler för en kategori anger hur ett fordon placerat efter ett fordon i denna kategori ska regleras.
5. System enligt något av tidigare krav, varvid nämnda förutbestämda kategorier innefattar trådlöst sändande fordon i fordonståget och/eller trådlöst sändande fordon utanför fordonståget och/eller okänt fordon i fordonståget.
6. System enligt något av ovanstående krav, varvid nämnda data innefattar trådlöst överförda signaler.
7. System enligt något av ovanstående krav, varvid nämnda data innefattar data mottaget via radar, kamera och/eller GPS (Global Positioning System).
8. Metod för att reglera fordon i ett fordonståg som innefattar ett ledarfordon och åtminstone ett ytterligare fordon anpassade att kommunicera via trådlös kommunikation, metoden innefattar stegen att - ta emot data relaterat till en eller flera fordonsparametrar för ett fordon i fordonståget eller ett fordon i ett område kring fordonståget, varvid datan innefattar identifieringsdata som indikerar från vilket fordon nänmda data kommer ifrån; - analysera nämnda data enligt förutbestämda kriterier som innefattar att jämföra identifieringsdata från mottagen data med identifieringsdata för fordonståget och fusionera ernottagen identifierbar data för att estimera ett eller flera fordonstillstånd för fordonet; - kategorisera nämnda fordon i en av ett förutbestämt antal kategorier baserat på resultatet av nämnda analys; varvid kategorierna innefattar åtminstone 1) trådlöst sändande fordon i fordonståget och 2) trådlöst sändande fordon utanför fordonståget och varje kategori anger regler för hur åtminstone ett fordon i fordonståget ska regleras beroende på kategoriseringen; - generera åtminstone en styrsignal som indikerar hur ett eller flera fordon i fordonståget ska regleras baserat på nämnda kategorisering och fordonstillstånd; - reglera åtminstone ett fordon i fordonståget i enlighet med styrsignalen. 18 10 15 20 25 30 536 649
9. Metod enligt krav 8, som innefattar att kategorisera fordon åtminstone delvis beroende på med vilken metod nämnda data tagits fram.
10. Metod enligt något av kraven 8 till 9, som innefattar att analysera nämnda data genom att estimera fordonets längd l, beräkna en skillnad Al mellan den estimerade längden och en förutbestämd längd och jämföra Al med ett förutbestämt tröskelvärde, samt kategorisera fordonet i beroende av resultatet av jämförelsen.
11. Metod enligt något av kraven 8 till 10, varvid nämnda regler för en kategori anger hur ett fordon placerat efter ett fordon i denna kategori ska regleras.
12. Metod enligt något av kraven 8 till ll, varvid nämnda förutbestämda kategorier innefattar trådlöst sändande fordon i fordonståget och/eller trådlöst sändande fordon utanför fordonståget och/eller okänt fordon i fordonståget.
13. Datorprogramprodukt, innefattande datorprograminstruktioner för att förmå ett datorsystem att utföra stegen enligt metoden enligt något av kraven 8 till 12, när datorprograminstruktionerna körs på nämnda datorsystem.
14. Datorprogramprodukt enligt krav 13, där datorprograminstruktionerna är lagrade på ett av ett datorsystem läsbart medium. 19
SE1250629A 2012-06-14 2012-06-14 System och metod för reglering av fordon i fordonståg SE536649C2 (sv)

Priority Applications (3)

Application Number Priority Date Filing Date Title
SE1250629A SE536649C2 (sv) 2012-06-14 2012-06-14 System och metod för reglering av fordon i fordonståg
EP13803923.5A EP2862158B1 (en) 2012-06-14 2013-06-12 System and method for regulation of vehicles in vehicle trains
PCT/SE2013/050672 WO2013187834A1 (en) 2012-06-14 2013-06-12 System and method for regulation of vehicles in vehicle trains

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
SE1250629A SE536649C2 (sv) 2012-06-14 2012-06-14 System och metod för reglering av fordon i fordonståg

Publications (2)

Publication Number Publication Date
SE1250629A1 SE1250629A1 (sv) 2013-12-15
SE536649C2 true SE536649C2 (sv) 2014-04-29

Family

ID=49758535

Family Applications (1)

Application Number Title Priority Date Filing Date
SE1250629A SE536649C2 (sv) 2012-06-14 2012-06-14 System och metod för reglering av fordon i fordonståg

Country Status (3)

Country Link
EP (1) EP2862158B1 (sv)
SE (1) SE536649C2 (sv)
WO (1) WO2013187834A1 (sv)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE537578C2 (sv) * 2013-09-30 2015-06-30 Scania Cv Ab Styrenhet och metod för att reglera ett fordon i ett fordonståg
WO2016013996A1 (en) * 2014-07-25 2016-01-28 Okan Üni̇versitesi̇ A close range vehicle following system which can provide vehicle distances and course by using various variables.
US9632507B1 (en) 2016-01-29 2017-04-25 Meritor Wabco Vehicle Control Systems System and method for adjusting vehicle platoon distances based on predicted external perturbations
US11136029B2 (en) 2016-11-09 2021-10-05 Volvo Truck Corporation Method for controlling a vehicle
US10482767B2 (en) 2016-12-30 2019-11-19 Bendix Commercial Vehicle Systems Llc Detection of extra-platoon vehicle intermediate or adjacent to platoon member vehicles
DE102017222216B3 (de) 2017-12-07 2019-05-29 Volkswagen Aktiengesellschaft Verfahren zur Durchführung von Abstandsmessungen zwischen den Fahrzeugen einer Fahrzeugkolonne sowie Fahrzeugmodul zur Verwendung bei dem Verfahren sowie Fahrzeug
EP4002320B1 (en) 2020-11-24 2024-10-30 Volvo Autonomous Solutions AB A method for cooperative adaptive cruise control
DE102023200496A1 (de) * 2023-01-24 2024-07-25 Siemens Mobility GmbH Verfahren zum automatischen Steuern eines Schienenfahrzeugs, Schienenfahrzeug und Verband aus wenigstens zwei Schienenfahrzeugen

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3634302A1 (de) * 1986-10-08 1988-04-21 Porsche Ag Abstandsregelungssystem fuer kraftfahrzeuge
JP3358403B2 (ja) * 1995-09-11 2002-12-16 トヨタ自動車株式会社 隊列走行制御装置
DE10348635B4 (de) * 2003-10-15 2007-02-08 Daimlerchrysler Ag Verfahren zur Zielführung von Kolonnenfahrzeugen
US20070233337A1 (en) * 2005-09-14 2007-10-04 Plishner Paul J Semi-autonomous guidance system for a vehicle
SE531835C2 (sv) * 2007-12-03 2009-08-25 Scania Cv Abp Förfarande och anordning för att stödja en reglerstrategi för framförandet av ett fordon
JP5516070B2 (ja) * 2010-05-25 2014-06-11 トヨタ自動車株式会社 車群管理方法および隊列走行通信システム
JP5573461B2 (ja) * 2010-07-27 2014-08-20 トヨタ自動車株式会社 車両制御システム
JP5668359B2 (ja) * 2010-08-11 2015-02-12 トヨタ自動車株式会社 車両制御装置

Also Published As

Publication number Publication date
EP2862158B1 (en) 2020-12-09
WO2013187834A1 (en) 2013-12-19
SE1250629A1 (sv) 2013-12-15
EP2862158A4 (en) 2016-02-17
EP2862158A1 (en) 2015-04-22

Similar Documents

Publication Publication Date Title
SE536649C2 (sv) System och metod för reglering av fordon i fordonståg
US10942521B2 (en) Method and apparatus for determining a vehicle control parameter, vehicle on-board controller and autonomous vehicle
US10422649B2 (en) Autonomous driving sensing system and method
KR101664716B1 (ko) Cacc 시스템의 속도 제어 장치 및 그 방법
JP5522193B2 (ja) 先行車特定装置
EP2862160B1 (en) System and method for regulating of vehicle pertaining to a vehicle train
EP3644294A1 (en) Vehicle information storage method, vehicle travel control method, and vehicle information storage device
EP3637391A1 (en) Information processing device
CN111201173B (zh) 用于确定车辆轮胎与车道之间的接触的摩擦值的方法以及用于控制车辆的车辆功能的方法
JP2018055539A (ja) 移動体の状態算出装置、状態算出方法、プログラムおよびそれを記録した記録媒体
JP5904226B2 (ja) 車両挙動予測装置及びプログラム
US10803683B2 (en) Information processing device, information processing method, computer program product, and moving object
US20210058814A1 (en) Methods and systems for processing traffic data from vehicles
JP2019184607A (ja) 衛星支援によって車両位置を特定するための方法
JP5378002B2 (ja) 車両動作推定装置、車両動作推定方法および車両動作推定プログラム
JP2012059058A (ja) 危険推定装置及びプログラム
EP2862157B1 (en) System and method pertaining to vehicle trains
CN115629375A (zh) 使用交通工具对交通工具技术提高雷达数据预测的准确度
US20210206392A1 (en) Method and device for operating an automated vehicle
JP2006343814A (ja) 交通管制システム及び交通管制システムに情報を送信するための車載器
US20180326978A1 (en) Method and device for generating an environment model for a vehicle
US20230128379A1 (en) Method and device for evaluating a function for predicting a trajectory of an object in an environment of a vehicle
Worrall et al. A probabilistic method for detecting impending vehicle interactions
JP6807215B2 (ja) 制御装置、推定方法及びプログラム
US20240040605A1 (en) Communication control method and communication system