Optica Sportiva Echipament Militar Aparatura Medicala Lentile de Ochelari Optica Libera Cercetare Dezvlotare

Limba / Language:

romana english

Cautare

PROGRAM Inovare - Proiect Robo-Mocs

Ca abordare noua bazata pe dezvoltarile de ultima ora din domeniu, proiectul va fi realizat intr-un concept larg utilizat in tarile dezvoltate, cel al utilizarii componentelor „din raft” sau „dual use”, prin canalizarea eforturilor proprii spre acele parti ale proiectului in care avem calificarea, experienta si forta de munca necesare. O parte dintre echipamentele de supraveghere care se monteaza pe robot sunt deja in curs de realizare in cadrul proiectului OPTELLA coordonat de S.C. IOR S.A.. Ca urmare a acestor considerente, pentru optimizarea unor solutii robuste si realiste fata de un set de cerinte ale beneficiarului, strategia tehnica de realizare a proiectului impune utilizarea predominanta a componentelor”din raft”. In principiu, ROBO-MOCS trebuie sa poata actiona in teren cu denivelari dar si sa poata intra in tuneluri, bunkere, canale cand este utilizat in localitati. Va fi un robot cu roti sau senile, ieftin, actionat de la distanta, cu un dispozitiv tip joystick, printr-o legatura de RF. Robotul este compus din sistemul de rulare, sistemul de comanda si sistemul de senzori. Pentru a-si indeplini misiunea ROBO-MOCS va avea urmatoarea componenta: Platforma de baza a robotului, constituita din mobilul propriu-zis, sasiu, roti sau senile de deplasare, motoare, senzori de pozitie, automatica de actionare si executie a comenzilor, baterii de alimentare; Echipamentul de calcul care asigura intreg managementul robotului; Software inteligent pentru navigatie si operare; Senzori pentru deplasare si detectare obstacole; Brat articulat pentru manevra sarcinii utile; Senzorii atasati robotului pentru a indeplini o misiune. Ne propunem sa concentram cercetarea pe patru aspecte principale: Echipamentul de calcul - creierul robotului; Software inteligent pentru managementul deplasarii si indeplinirii misiunii de catre robot; Echipamentul pentru telecomanda robotului si transmiterea informatiilor la operatorul uman; Realizarea unor senzori performanti care sa confere robotului calitatile de observare, cercetare si supraveghere video (posibil si audio) a unei zone ce prezinta pericol sau nu este accesibila omului. Printre senzorii si echipamentele ce se vor realiza vor fi ca o cerinta minima: Echipament de observare optica zi/noapte si in conditii de iluminare redusa;Camera termala pentru distante scurte; Iluminator laser de medie distanta; Echipament de detectare a aparatelor optice; Echipament de compresia imaginilor. modificat ddd lll sss

Descrierea echipamentelor:

  1. Platforma de baza a robotului va fi compusa din elementele necesare deplasarii robotului, cele de sustinere a sarcinii utile pentru observare, alimentarea sistemului si mijloacele de comunicatie cu operatorul uman pentru comenzi si obtinerea de informatii. Caracteristicile esentiale ale platformei de baza sunt: - Dimensiuni: 500X400X300 mm; masa 12-15 kg; masa utila 10-12 kg;Tractiunea va putea fi cu roti sau senile si va fi aleasa la modelul experimental si in principiu va fi bazata pe 4 roti motrice.Rotile sau senilele vor fi actionate de 2 motoare de curent continuu care vor fi cuplate cu cutii de viteze variabile pentru un control mai eficient al puterii si cuplului motoarelor; Alimentare de la baterii de 12V sau 24V cu o putere de 200-250 W asigurand o misiune de 3-4 ore, cu o viteza de 1-1,5 km/ora si o panta maxima de 35-45%;

    -Va avea in compunere un microcontroler care va furniza toate comenzile necesare deplasarii robotului, elaborate de computerul propriu sau cele primite de la operator, scop in care acesta va avea implementat un software adecvat care va face si monotorizarea senzorilor montati pe platforma precum accelerometre, inclinometre, senzori de temperatura si de curent; In baza va fi inclus si calculatorul de bord care va culege datele de la mediul de deplasare prin senzorii de proximitate, va receptiona instructiunile primite de la operator si in baza unui program bazat pe inteligenta artificiala va lua deciziile pe care microcontrolerul le va executa asigurand deplasarea robotului si culegerea datelor;

    -Va avea in compunere un modem radio de preferinta in banda de 2,4 GHz, care va primi comenzile de la distanta si va transmite informatiile utile culese de robot si de asemenea in baza vor fi inclusi si senzorii de proximitate (sonar si IR) prin care sunt detectate obstacolele si cu ajutorul carora robotul va trebui sa rezolve problema spinoasa a evitarii acestora.

  2. Echipamentele de culegerea informatiilor.

    1. Echipament de observare optica zi/noapte si in conditii scazute de iluminare.

      Caracteristici principale: Sensibilitate ridicata - Color: 0.8 lx (F1.4, 50IRE) / A/N (Mod Zi/Noapte): 0.07 lx (F1.4, 50IRE); 480 linii orizontale; Iesire video PAL; Sistem de ZOOM motorizat pentru control de la distanta; Compensarea iluminarii (selectabila): Interfata RS-485 pentru control si transmitere la distanta; Rezolutie 752x582; Alimentare duala 12V sau 24 V pentru o mai mare compatibilitate.

    2. Camera termala pentru distante scurte;

      Caracteristici:Microbolometru fara racire cu rezolutie de 320x240; Unghiul de observare 7x5 grade (HXV); Rezolutie spatiala 0,4 mrad; ZOOM electronic 2x; Incalzitor automat; Iesire video PAL;Tensiunea de alimentare 14-32 V; Puterea consumata 8W; Temperatura de operare -32/+550 C; Control si transmitere la distanta prin interfata RS232; Distanta detectie persoana 1,6 km; Distanta de detectie a obiectelor 4,4 km.

    3. Iluminator laser de medie distanta VIS – (ג= 635nm) si IR – (ג= 830nm), ILIR- cu urmatoarele caracteristici principale: distanta de actiune in VIS - nu mai mica de 25m; distanta de actiune in IR - nu mai mica de 20m; puterea comsumata – nu mai mare de 150mW din baterie de 6V.

    4. Echipament de detectare aparate optice de supraveghere.-DECT-400;

      Detectia aparatelor optice este o problema de mare necesitate cu multiple aplicatii civile si militare. Pe cat este de utila pe atat este de complicata realizarea, deoarece are la baza un efect optic cunoscut al „ochiului de pisica” dar greu de pus in evidenta, la distante mari 400-500m. In domeniu sunt totusi realizari remarcabile atat in vest cat si in est, rusii fiind mari specialisti. Echipamentul va fi destinat pentru: protectia persoanelor VIP; descoperirea tragatorilor; descoperirea aparatelor optice de supraveghere, in incaperi sau afara; descoperirea paparazilor; asigurarea protectiei obiectivelor importante; in activitati antiteroriste. Cateva caracteristici de baza ale aparatului-DECT-400: reflexia radiatiei laser, (R= 0,1…0,25) la suprafata obiectivelor optice, cu λ = 905nm; distanta de descoperire a tragatorilor de elita – nu mai mica de 200 m; camp de vedere: 4x3grade; distanta minima de actiune -1m; Iesire video; autonomia de functionare -1,5ore; masa nu mai mare de 1,5Kg.

    5. Echipament de compresia imaginilor;

      Echipamentul va prelua semnalul video de la camera de supraveghere, il va transforma in semnal digital si il va comprima folosind un algoritm standard de compresie sau unul complet nou functie de nevoi. Va fi realizat cu un procesor de semnal DSP sau va putea fi implementat software in procesorul robotului conditia principala de indeplinit fiind cea a unui raport de compresie cat mai mare asigurand viteze de transmitere a imaginilor pe canale de banda larga: 20-25 imagini/secunda; iar pe canale de banda ingusta: 2-3 imagini/secunda. Aceste caracteristici permit robotului sa transmita imagini din locuri acoperite unde comunicatiile de banda larga nu functioneaza, utilizind comunicatii radio UHF de banda ingusta.

REALIZARI PE ETAPE:

ETAPA I

Proiectul „ROBOT MOBIL PENTRU OBSERVARE, CERCETARE SI SUPRAVEGHERE – ROBO-MOCS “ si-a propus sa realizeze in etapa I "Studiul privind realizarea platformei de bază a robotului purtător de senzori de cercetare".

In structura acestui studiu a fost abordata o problematica complexa, determinata de necesitatea definirii principalelor subsisteme componente ale acestui robot mobil, care sa poata fi dezvoltate in etapele ulterioare. Pornind de la o structura de baza specifica unor roboti mobili, in cadrul studiului realizat pe capitole, s-a procedat la o analiza in detaliu a unor subsisteme de baza, evidentiind realizarile specifice pe plan mondial in acest domeniu, care in ultima perioada cunoaste o dinamica de dezvoltare de-a dreptul impresionanta.

In figura alaturata se prezinta o schema functionala a robotului mobil ce urmeaza a se realiza in cadrul proiectului ROBO-MOCS.

Pentru realizarea acestui sistem de robot mobil s-a preliminat folosirea unei platforme mobile din familia MMP-40, care este o platformă simplă senilata şi cu aplicatii dedicate în robotica de cercetare şi supraveghere. Parametrii principali ai acestei platforme sunt:

Actionare:

Comanda acţionării se face prin interfata RS-232 sau interfata standard PMW;
Alimentarea de la baterii 24V NiCad-7,2 Ah reîncărcabile, autonomie 2 ore.

Un element important in structura sistemului este si „Consola de Telecomanda’’ (CDT), care este constituită din urmatoarele parti: unitate de calcul, memorare şi afisare; unitate de comenzi; unitate de comunicatii; unitate de alimentare. Unitatea de calcul va fi realizata sub forma unui laptop robustizat cu performante necesare gestionarii comenzilor, informatiilor video, permitand afisarea imaginilor transmise de robot si a informatiilor de stare si pozitie a robotului. Unitatea de comenzi va fi realizata in mai multe variante, de preferinta cu produse “din raft” iar solutia definitiva se va stabili după experimentari. Unitatea de comunicatii va cuprinde echipamentele de transmitere si receptie radio atat pentru imagini cat si pentru comenzi si date.

Analiza principalilor senzori si realizarea fuziunii datelor

In sectiunea destinata analizei pentru "Senzori si fuziunea datelor", se prezinta mai multe tipuri de senzori pentru masini automate, precum si senzori specifici robotilor mobili (cu ultrasunete, inertiali, vizuali, de orientare vizuala, pentru urmarirea drumului sau detectarea obstacolelor), senzorii liniari si de rotatie, senzorii de accelerare, de proximitate si de imagine. Elementul forte il constituie analiza modului de utilizare a senzorilor pentru a permite robotului sa vada, sa auda si sa simta, facilitati rezultate din actiunea de conlucrare a diferitilor senzori, aspect tratat intr-o sectiune special destinata.

Studiile preliminare au arătat că pentru cercetarea în teren pe distanţe mari este nevoie ca operatorul să fie ajutat în teleoperarea robotului cu sistem de calcul şi cu o suita de senzori care îi vor permite o navigare mai usoara dar va aduce bineinteles costuri suplimentare,sofisticarea sistemului şi consumuri mai mari. In principal sistemul anticoliziune va consta într-o reţea de senzori IR si o retea de senzori sonar. Suplimentar este posibil ca pe sasiu sa se monteze doua camere video una care vede in fata si una care vede in spate pentru a ajuta operatorul în manevrare (camerele sunt cu nivel scazut de iluminare si focalizare fixa).

Senzori tip SONAR

Detectorii de distanta bazati pe sonar au la baza principiul timpului necesar unui pachet(impuls) de unde acustice de a parcurge distanta pana la un obstacol, cunoscandu-se viteza in aer se poate determina distanta. Datele sonar sunt larg folosite în robotii mobili din cauza pretului scazut si a relativei independente fata de mediu, lumina, fum etc. Datele furnizate de sonar sunt utilizate atat pentru detectarea obstacolelor cat si pentru ridicarea hartii terenului. Totusi datele furnizate de sonar sunt afectate de o serie de erori cu implicatii majore asupra preciziei masuratorilor care depind de temperatura si presiune a mediului.

 

Senzori IR

Printre alte tipuri de senzori utilizati pentru detectarea obstacolelor se numara si senzorii IR . Ei lucrează la fel ca celelalte tipuri de senzori, masurand timpul de intarziere al unui semnal emis si apoi receptionat datorita reflexiei de obstacole. Acest tip de senzori au cateva calitati care îi fac atractivi: pret de cost redus, diagrama de directivitate îngusta (de ordinul gradelor si fractiuni de grad), distante acceptabile pentru roboti(de la cativa cm la 6-7 m). Principalul dezavantaj îl reprezinta faptul ca pot da multe masuratori eronate datorate diverselor surse de lumina si reflexivitatii variabile a mediului de deplasare.

In figura alaturata se prezinta schema cu modul de utilizare a senzorilor IR pentru evitarea obstacolelor.

Camere video de manevre si camere pentru stereo-viziune

Pentru dirijarea robotului se vor monta doua camere in partea din fata a robotului pentru a furniza operatorului imagini din fata platformei acoperind si zonele laterale pe care va rula robotul. Imaginile vor fi transmise operatorului în timp real si care stau la baza dirijarii. Printre cele mai performante sisteme de navigare folosite în robotică si in care se fac eforturi permanente cu rezultate remarcabile sunt sistemele stereo care foloseste pentru determinarea distantei principiul de lucru al ochiului uman. Alaturat se da o schita de principiu a unui sistem stereo care este compus din două camere dispuse la o anumita distanta numita baza. Principiul de determinare a adancimii (distantei) imaginii ilustrat in continuare este destul de simplu. Se defineste diferenta intre imaginile vazute cu cele doua camere numita disparitate si apoi se calculeaza distanta ca o functie de disparitate si baza. Complexitatea problemei este data de executarea in timp real a calculului distantei la toate punctele din imagine ceea ce presupune o mare putere de calcul. Problema este rezolvata de actualele procesoare de semnal care se integreaza chiar in electronica celor doua camere. Cu toate rezultatele excelente obtinute pretul unor asemenea sisteme este mare si este dictat de software-ul de prelucrare. In figurile alaturate sunt prezentate: un exemplu de vedere stereo, un robot echipat cu camere cu stereo viziune, si se pot vedea versiuni ale Camerei stereo STOC.

 

Senzori de scanare tip LASER

Scanarea laser este o metoda larg utilizata pentru ridicarea hartii terenului avand la baza acelasi principiu al reflexiei, razei laser si al masurarii timpului de propagare. Este o metoda foarte precisa dar majoritatea dispozitivelor oferite pe piata sunt de mari dimensiuni, grele, consumatoare de energie. In ultimul timp au aparut realizari de inalta performanta in domeniu, un exemplu fiind produsul prezentat alaturat si pe care intentionam sa-l folosim la proiect.

 

Sistem de navigatie inertiala, senzori de masurare a miscarii robotilor

Masurarea fara informatii exterioare (Dead-reckoning) utilizeaza codoare care masoara rotatia rotilor si/sau orientarea directiei. Are avantajul ca nu foloseste elemente de orientare exterioare si este capabila sa furnizeze in permanenta estimarea pozitiei vehiculului. Dezavantajul metodei este dat de erorile de masura care se datoreaza terenului si care se acumuleaza continuu fiind nevoie ca periodic sa se refaca referinta pentru a reduce erorile. Navigatia inertiala utilizeaza giroscoape si accelerometre pentru a masura viteza de rotatie si acceleratia. Aceste sisteme au de asemenea avantajul ca nu necesita repere exterioare fiind complet independente. Prin integrarea o data sau de doua ori se obtine pozitia robotului. Pe de alta parte datorita nevoii de integrare erorile se acumuleaza si nu avem o determinare precisa a pozitiei pe o mare perioada de timp. O alta problema majora o reprezinta preturile de cost mari pentru produse de inalta performanta. In ultimul timp au aparut insa special pentru roboti giroscoape si accelerometre de precizii acceptabile si la preţuri rezonabile. Un exemplu de sistem de navigatie inertiala este produsul MTi-G realizat de compania XSENS—prezentat alaturat. Are dimensiuni reduse şi greutate mica fiind recomandat pentru controlul si navigatia sistemelor autonome. Este un sistem inertial avand integrat si un GPS si un senzor de presiune statica. Procesorul incorporat asigura fuziunea datelor in timp real furnizand orientarea 3D cu un drift scazut si un GPS îmbunatatit. De regula in cazul majoritatii robotilor, echiparea cu senzori este modulara si se va efectua functie de tipul de misiune.

Echipamentele de culegere informatii

Cerinte exprese pentru sistemul de senzori video: este cunoscut faptul ca succesul oricarui vehicul de culegere a informatiilor video depinde de abilitatea operatorului de a fi asistat de imaginile video primite, imagini care trebuie sa fie clare si stabile. Avand aceste imagini operatorul are control total asupra robotului. Apar referitor la dirijarea pe baza imaginii video urmatoarele probleme:1) imaginile video transmise pe canale analogice sufera de interferente si degradare; 2) imaginile video transmise pe canale digitale necesita benzi largi(10 cadre pe secundă); 3) jiterul mecanic, cand robotul se deplasează; 4) nevoia de rezolutie mare pentru camera de cercetare si existenta unui sistem de stabilizare a imaginii si a unui zoom de aproximativ 24x, autofocus, autoiris si stabilizarea electronica a imaginii. Echipamentele de culegere informatii se vor monta pe o platforma sprijinită de un pilon rabatabil care sa poata fi manevrat în directie si inaltime, astfel:

Experimentari-Testari-Simulari.

Experimentarile efectuate pana in aceasta faza a proiectului au utilizat platforma hardware si software IntelliBrain Bot DeLuxe. Acesta este o platforma creata cu scop educational. Experimentarile efectuate cu ajutorul acestei platforme au avut ca scop scrierea de secvente de program sau adaptarea unora existente pentru:

Pentru desfasurarea testelor listate la punctul 5 am avut la dispozitie urmatoarele :

Rezultatul experimentelor implementarii unei aplicatii care asigure navigarea robotului si controlul la distanta al acestuia.

Obiectivele propuse au fost urmatoarele :

Studiu privind utilizarea vederii stereo si omnidirectionale pentru evitarea obstacolelor de catre roboti 

ETAPA a II-a

Proiectul „ROBOT MOBIL PENTRU OBSERVARE, CERCETARE SI SUPRAVEGHERE – ROBO-MOCS“ si-a propus sa realizeze in etapa II "MODELUL EXPERIMENTAL" al robotului de observare, cercetare si descoperire. Prin activitatile propuse am incercat sa acoperim acele zone ale cercetarii care pun probleme deosebite in realizarea unui robot mobil: realizarea unei baze sigure si eficiente care sa poata sta la baza indeplinirii misiunilor ROBO MOCS; Telecomanda bazei la distante corespunzatoare cerintelor; Realizarea unui sistem de teledirijare eficient sub forma unui “Echipament Optronic pentru Teledirijarea unui Robot Mobil” care face si obiectul unui brevet de inventie depus la OSIM; Realizarea unui sistem de alimentare care sa asigure o autonomie de 2-4 ore; Montarea si verificarea unor senzori utili pentru navigatia robotului; Montarea sarcinii utile, senzorii de vedere de zi si noapte; Realizarea calculatorului de bord; Realizarea unor pachete de programe care sa asigure citirea senzorilor, determinarea pozitiei robotului, comanda motoarelor, citirea si prelucrarea imaginilor; Realizarea sistemului de transmitere la distanta a imaginilor.
Principalele activitati desfasurate in cadrul Etapei a II-a au fost concentrate pe realizarea unei analize de detaliu care a vizat:
- realizarea unei baze sigure si eficiente care sa poata sta la baza indeplinirii misiunilor ROBO MOCS;
- realizarea unui sistem de teledirijare eficient sub forma unui “Echipament Optronic pentru Teledirijarea unui Robot Mobil” care face si obiectul unui brevet de inventie depus la OSIM;
- realizarea unui sistem de alimentare care sa asigure o autonomie de 2-4 ore;
- montarea si verificarea unor senzori utili pentru navigatia robotului;
- realizarea unor pachete de programe care sa asigure citirea senzorilor, determinarea pozitiei robotului, comanda motoarelor, citirea si prelucrarea imaginilor;
- realizarea iluminatorului laser VIS si IR, precum si a echipamentelor de detectie sonar, laser, IR;
- elaborarea documentatiei de executie ME pentru platforma robot, iluminator laser, echipamente de detectie;
- elaborarea manualului de utilizare a modelului experimental al robotului;
- experimentarea modelului robotului;
- prezentarea dovezii de protejare a proprietatii intelectuale si a planului de afaceri pentru robot si recuperarea investitiei in 4,4 ani.


Din schema de ansamblu rezulta principalele componente ale ROBO MOCS astfel:

1.1 Baza robotului:

Pentru realizarea acestui sistem de robot mobil a fost folosita o platforma mobila din familia MMP-40, care este o platformă simplă senilata şi cu aplicatii dedicate în robotica de cercetare şi supraveghere. Parametrii principali ai acestei platforme sunt:
-Dimensiuni: Lungime x Latime x Inaltime 70x50x20cm.
-Greutate: 20 Kg;
-Sarcina utila: 10 Kg suplimentar;
-Corp realizat din aluminiu cu acoperiri speciale;
-Actionare: 2 Motoare a 100W fiecare;
-Autonomie 2 ore

1.2 Sistemul de telecomanda


Un element important in structura sistemului robotic este si “Consola de Telecomanda” (CDT), care este constituită din urmatoarele parti: unitate de calcul, memorare şi afisare; unitate de comenzi; unitate de comunicatii; unitate de alimentare. Pentru modelul experimental a fost folosita o telecomanda RC standard lucrand pe frecventa de 2400 MHz si avand o distanta de actiune de 300m, suficienta pentru experimentarea platformei. O serie de comenzi date de telecomanda au fost modificate si folosite la receptie pe robot pentru managementul echipamentelor de culegere video si stabilirea regimurilor de functionare ale robotului.







1.3 Senzorii pentru navigatia robotului

Pentru cercetarea în teren pe distanţe mari este nevoie ca operatorul să fie ajutat în teleoperarea robotului cu un sistem de calcul şi cu o suita de senzori care sa îi permita o navigare mai usoara la modelul experimental a fost aleasa solutia unui sistem anticoliziune constand dintr-o retea de senzori sonar(5 sonare) dispusa in partea frontala, un compas electronic care furnizeaza permanent capul compas(directia) si unghiurile de inclinare ale robotului, un sistem de odometrie pentru determinarea pozitiei robotului prin masurarea drumului parcurs.


1.3.1 Senzori pentru detectarea obstacolelor de tip SONAR

Sonarul este larg folosit în detectia obstacolelor pentru robotii mobili din cauza pretului scazut si a relativei independente fata de mediu, lumina, fum etc. Principalele caracteristici ale sonarului utilizat:
- Distanta - 3cm la 6ms
- Diagrama de dir. 60 grade;
- se pot face 3 citiri pe secunda (aprox.3,3 Hz).
Pentru a realiza o detectie eficienta au fost utilizate 5 sonare care acopera complet o zona unghiulara de 60-80 grade in fata robotului, dispunerea facandu-se ca in figura de mai jos.


Am reusit ca realizand tuburi de 3cm cu material absorbant sa ingustam diagrama de directivitate la 10-15 grade fara o scadere apreciabila a distantei de detectie.

 



1.3.2.Senzorii odometrici

In calitate de senzori de rotatie se folosesc doua encodere cu rezolutia: 500impulsuri/rotatie.
Pozitia encoderelor este citita de microcontroler, transformata in elemente de pozitie a robotului x, y, θ(orientare) si este folosita de robot pentru navigatie. Preciziile obtinute in determinarea pozitiei se apreciaza ca fiind de ordinul a 4÷5%.

1.3.3 Senzorii de pozitie a robotului(Compasul magnetic digital)

Pozitia robotului calculata pe baza odometriei are erori mari dar recalculata folosind unghiul furnizat de busola, rezultatele se imbunatatesc radical. Principalele caracteristici:
-precizie in directie: 0.5º;
-precizia in inclinare: <1º;


Datele furnizate de busola, capul compas si inclinarea robotului in cele doua planuri, se transmit operatorului pentru a cunoaste in permanent pozitia robotului, in acelasi timp vor fi utilizate la calculul automat al pozitiei robotului, compensand erorile furnizate prin odometrie. Eroarea in furnizarea capului compas este sub 0,7%.

1.3.4 Echipamentul Optronic pentru TEledirijarea unui Robot Mobil(EOTERM).

A fost realizat un Echipament optronic pentru teleoperarea robotilor mobili, sub forma unei combinari a unei camere omnidirectionala cu o camera directionala cu o dispunere speciala pentru a servi la teleoperarea unui robot mobil. Echipamentul inlatura neajunsurile camerelor omnidirectionale, precum rezolutia scazuta, lipsa zoom-ului, efectul de bluring, coma si astigmatism, prin montarea unei camere directionale care poate creea imagini de inalta calitate in orice punct de interes al imaginii omni. Aplicatiile echipamentului sunt multiple si se refera la culegerea imaginilor de pe mobile in miscare, culegerea informatiilor in sistemele de supraveghere, telecomanda robotilor, navigatia autonoma a robotilor. Avantajul principal in teleoperarea robotilor este ca operatorul aflat la distanta are iluzia ca se gaseste dispus chiar pe robot iar terenul pe care il vede camera omni si deci si operatorul este nedistorsionat, pana la distanta de 2-3 m. Echipamentul realizat este propus pentru brevetare la OSIM.





1.3.5 Echipamentul stereo pentru detectia obstacolelor.

Pentru proiectul propus culegerea informaţiilor furnizate de 2 camere web s-a facut prin achiziţia de imagini cu librăria de instrumente virtuale IVISION V1.8 de la HypertechFuncţiile de procesare a imaginilor sunt bazate pe librăria Intel OpenCV.
Deoarece camerele web sunt conectate orizontal şi eroarea de paralaxă este folosită pentru calculul distanţei la obiecte, rezulta ca detaliile verticale sunt cele mai importante pentru a fi evidenţiate. Acest lucru se obţine realizând o derivare a imaginii pe linii.
Locaţia acestor zone de interes pe orizontala poate fi data de rezultatul derivării imaginii mai sus prezentat. Pentru poziţionarea lor pe verticală se va împărţi imaginea in benzi verticale cu lăţimea egala cu a zonei de interes. Astfel ca pentru zone de interes cu dimensiune mica vor fi mai multe astfel de benzi pe care se va realiza căutarea, rezultând o rezoluţie mai buna. În cazul zonelor mai mari vor fi mai puţine astfel de benzi si deci o rezoluţie mai mică:



Din exemplul ataşat se remarca ca pe orizontală zonele de interes se pot întrepătrunde. Este posibilă şi o întrepătrundere pe verticală însa timpul de calcul creste semnificativ, limitarea fiind data doar de puterea de calcul al sistemului folosit.

1.4 Echipamentele pentru culegerea informatiilor.

1.4.1 Camera CCD

Camera montata pe robot este o camera de mare performanta, capabila sa furnizeze imagini de calitate cu un castig in zona IR de minim 0.8 pentru a putea lucra in conjunctie cu un iluminator in IR cu ajutorul caruia poate vedea zonele umbrite si cele intunecate din timpul noptii..A fost aleasa o camera zoom variabil de 24x, autoiris si autofocus. In cazuri speciale camera va avea si un sistem de stabilizare a imaginii.Principalele caracteristici:
-Rezolutie PAL 460 linii TV;
-Optica - zoom 26X;
-Zoom digital 12X(312X impreuna cu zoom optic);
-Unghi de vizualizare orizontala : de la 42 degrade la 1.6 grade;
-Dimensiuni 55.3x57.5x81.8mm

1.4.2 Platforma de actionare a camerei CCD.

Platforma are doua grade de libertate in plan orizontal si in plan vertical. Prin comanda platformei camera CCD va lua imaginea zonei dorita de operator, marimea imaginii fiind reglata tot de operator prin comanda de la distanta a zoomului.

1.4.3 Iluminator Laser

S-a dezvoltat un iluminator IR de mici dimensiuni avand o amprenta larga astfel ca la distanta de 100 m sa poata supraveghea suprafete de 1x1m la 50m, cu urmatoarele caracteristici:
-Lungime de unda 790nm;
-Unghi de iluminare 1º -10º;
-Autonomie 3-4 ore;
Experimentarile efectuate au dat rezultate foarte bune o imagine aflata la 100m. este vazuta de camera CCD in conditii de intuneric total, ceea ce exclude nevoia unor camere cu intensificator de imagine exceptie facand misiunile in care se cere un echipament pasiv care sa nu poata fi descoperit de adversar.

1.4.4 Camera termala

Este destinata luarii de imagini in conditii de vizibilitate redusa, ceata, praf, fum, ploaie puternica sau pe timpul noptii. Prin camera termala pot fi supravegheate ansambluri de echipamente unde pot aparea temperaturi periculoase, cautarea fiintelor vii in daramaturi etc.Camera termala montata este o camera joasa rezolutie, mici dimensiuni si consum redus. Camera are urmatoarele caracteristici de baza:
-detector microbolometru FPA,
-rezolutie: 384x228 pixeli,
-banda spectrala: 8-14 microni,
-dist. de detectie om: 780m,
-camp vizual: 17x12º,
Camera utilizata pentru experimentari este o camera din productia IOR, realizata in cadrul proiectului OPTELLA si a corespuns cerintelor pentru model.

1.4.5 Camera de vedere pe timp de noapte cu intensificator de imagine.

Este un echipament de vedere care are inclus un intensificator de imagine dar si un sistem de extragerea automata a imaginii si este dedicata in special utilizarii ca echipament de vedere in cazurile cand robotul este destinat operatiunilor nocturne si are urmatoarele performante:
-grosisment: 3x,
-camp vizual:10,4º,
-distanta de observare;15m,
-intensificator de imagine:XR5,
-iesire video pentru preluare imagine.
Camera folosita este din productia IOR si a fost realizata in cadrul proiectului OPTELLA.

1.5 Alimentarea cu energie a platformei

Alimentarea se face de la un sistem de baterii care cuprinde doua pachete de baterii, unul pentru comanda motoarelor de 24V, 7,2Ah si un pachet de baterii pentru întreaga aparatura electrica avand o capacitate de 2000mAh -12V. De asemenea, platforma va dispune si de un sistem de incarcare a bateriilor.

1.6 Comunicatiile

Platforma ROBO-MOCS are nevoie de o legatura fara fir pentru date, video si audio.
Din analiza studiilor effectuate in utilizarea robotilor am ales ca frecventa de transmitere pentru imagini si date, frecventa de 900 Mhz propagarea in comparatie cu frecventele de 2,4Ghz.si mai mari fiind cu mult mai buna in special la utilizarea in cladiri. Modemul radio este realizat pe frecventa de 900MHz lucrand in conditii de mediu deosebite, de mici dimensiuni si greutate redusa asigurand o viteze de transmitere de 3Mbps si o putere de 200-500mW. Statia pereche montata pe echipamentul de telecomanda are in plus o antena directive(Yagi) de mici dimensiuni, corespunzatoare pentru asigurarea distantei de 500m(in cazuri speciale1000m, utilizand o statie radio care utilizeaza principiul diversitatii pentru a minimiza efectul reflexiilor multiple). O atentie deosebita a fost acordata locului de montare pe robot a antenei de emisie si tipului acesteia pentru a evita intreruperea transmisiei datorita obstacolelor din teren.Transmiterea datelor se face pe aceiasi statie radio folosind canalul audio pe care sunt montate modemuri de mica viteza. Astfel operatorul dispune de o reactie rapida a robotului care ii furnizeaza date de pozitie, viteza de deplasare, inclinare robot, stare senzori, diverse alarme.

1.7 Calculatorul de bord.

Deoarece ROBO MOCS este un sistem robotic mobil integrat avand un sistem senzorial compus din: sonare;senzori de contact; odometru si busola va fi dotat pentru asigurarea prelucrarilor si luarea deciziilor de un sistem multiprocesor special, denumit calculator de bord, care controleaza senzorii, miscarea si comunicatiile. Pentru etapa Model Experimental robotul este dotat cu 2 microcontrolere, unul pentru gestiunea si citirea senzorilor si al 2-lea pentru primire, formare comenzi si luarea deciziilor.

1.8 Platforma software pentru modelul experimental

Prin platforma software se întelege pachetul software care concureaza la managementul tuturor activitatilor pe care le face robotul:
-program citire senzori sonar-Sonar-1;
-program de citire pozitie robot(encodere)-Encod-1
-program de citire compas electronic-Compas-1;
-program calcul pozitie robot(odometrie)-Odometrie-1
-program pentru comanda motoare-Motor-1;
-program pentru comanda platforma camera CCD;

1.9 Experimentari-Testari-Simulari

Pentru experimentarile efectuate la modelul experimental am utilizat 2 microcontrolere cu pachetul de software de dezvoltare AVR Studio 4 sub compilator GCC care este sub licenta publica de utilizare GPL si bibliotecile cu functii aferente. Prelucrarile la distanta pentru teledirijarea pe baza imaginii omnidirectionale sau efectuat pe un Laptop cu pachetul de software descris mai jos:
Programele scrise pentru microcontrolere au avut ca scop urmatoarele operatiuni:
-Ridicarea caracteristicii de directivitate ale sonarelor.
-Etalonarea encoderelor de pozitie a rotilor motrice.
-Testarea senzorilor si actuatorilor cu care este dotata platforma.
-Testarea posibilitatii de a manevra robotul, in conditiile specificarii conditiilor deplasarii prin intervale de timp.

Program pentru transformarea imaginii circulare omnidirectionale in imagine panoramica. Principalele functii asigurate de acest pachet software sunt:
-Manipularea imaginilor video precum ar fi : alocarea, copierea, conversia.
-Captarea imaginilor video (din fisier sau direct de la camera video), precum si afisarea acestora. Formatul de imagine de la camera video este AVI.
-Functiile de baza pentru prelucrarea de imagine sunt : filtrarea, detectia de muchii, esantionare si interpolare, conversie de culori, operatii morfologice si generare de histograme.
-Calibrarea camerei video, analiza miscarii si recunoasterea de obiecte.

Aplicatia ImageProc este exclusiv dedicata prelucrarii imaginii omnidirectionale
Interfata grafica permite operatorului sa :
-selecteze sursa imaginilor video : fisier sau direct camera video,
-aleaga parametrii de prelucrare ai imaginii video,
-selecteze zona de interes din cadrul imaginii omnidirectionale.


COLECTIV DE CERCETARE:
Dr. ing. Nicolae IRIMIE
ing. Alexandru ZORILĂ
ing. Alexandru NAN
ing. Lucian SIMION
ing. Nicolae NEACŞU

 

ETAPA a III-a

Proiectul „ROBOT MOBIL PENTRU OBSERVARE, CERCETARE SI SUPRAVEGHERE – ROBO-MOCS“ si-a propus sa realizeze in etapa III "PROTOTIPUL" robotului de observare, cercetare si descoperire. Prin activitatile propuse am incercat in primul rand sa eliminam deficientele constatate la Modelul Experimental, sa gasim solutii de substituire pentru unele echipamente scumpe care au fost scoase din configuratie ca urmare a constrangerilor bugetare, sa folosim facilitatile software pentru cresterea performantelor, sa realizam si unele dintre componentele robotului ca echipamente independente in scopul creerii unei noi piete de desfacere.
Principalele activitati desfasurate in cadrul Etapei a III-a au fost concentrate pe proiectarea, realizarea, verificarea si experimentarea prototipurilor componentelor robotului, care au vizat: - realizare baza robot care include procesoarele pentru actionare si management, senzorii pentru asigurarea deplasarii, modulul de comanda si modulul de telecomanda;
- realizare optica pentru senzori si prototip camera omnidirectionala combinata pentru teledirijare, incluzand pachetul de software de navigatie;
- realizare prototip iluminator;
- realizare software pentru coordonarea activitatilor robotului si pentru deplasarea in zone cu obstacole;
- experimentarea prototipurilor elementelor robotului.
Activitatile desfasurate au avut ca finalitate realizarea documentatiei de prototip si executarea in baza ei a prototipului robotului ROBO MOCS.

1 Introducere

Din experimentarile efectuate cu modelul experimental si conditionati de reducerea alocatiilor financiare necesare realizarii unor echipamente am ajuns la necesitatea restructurarii componentei si solutiilor de realizare ale prototipului astfel ca acesta sa-si poata indeplini misiunea pentru care a fost conceput. In acest sens au fost operate urmatoarele modificari majore:
• refacerea carcasei in scopul usurarii si asigurarii conditiilor de etanseitate necesare in teren;
• refacerea sistemului de montare si calibrare a “compasului electronic”-busola-care a devenit un instrument de baza in determinarea pozitiei;
• suplimentarea sursei de alimentare cu un acumulator de mare capacitate(160Wh) pentru a spori autonomia conform cerintelor;
• introducerea unui sistem electromecanic de protectie la impact frontal cu obstacole;
• suplimentarea sistemului de detectie obstacole cu 2 sonare laterale;
• introducerea unui sistem de iluminare pentru noapte pentru a asigura deplasarea;
• introducerea unui echipament de comunicatii pentru legatura robot telecomanda in banda 400-500Mhz, capabil sa mareasca distanta de actiune si sa poata lucra si in cladiri;
• realizarea unei noi telecomenzi care sa evite utilizarea frecventelor de 2,4Ghz care sufera de neajunsuri in zone cu obstacole si in cladiri, in plus deoarece dirijarea robotului se face dupa imagine am introdus pentru prelucrare un procesor puternic si un monitor de afisare;
• realizarea unui controler FUZZY bazat pe comportamente ca o solutie de navigatie autonoma a robotului conducand la eliberarea operatorului de o activitate foarte stresanta;
• refacerea camerei omnidirectionale prin proiectarea unui set intreg de oglinzi in scopul obtinerii unei imagini cat mai clare a terenului si asigurarea posibilitatii acesteia sa lucreze noaptea folosind iluminarea in IR;
• introducerea unui senzor acustic(microfon) pentru captarea “zgomotului” din zona cercetata;
• Crearea unui canal de transmitere date intre robot si telecomanda prin care se vor putea transmite informatii de la diversi senzori montati pe robot(senzor chimic, de radiatii, de gaze, biologic, etc.).
In continuare vor fi descrise principalele solutii noi adoptate in cadrul proiectarii prototipului.

2.Calculatorul de bord ca element de baza care asigura toate actiunile pe care robotul le desfasoara autonom sau telecomandat.

Calculatorul de bord a fost restructurat fata de prototip reducandu-se la doua microcontrolere lucrand in regim de Master-Slave, constatandu-se ca puterea de calcul oferita este suficienta pentru a asigura functionarea robotului iar placa de procesor utilizata la model a fost transferata in telecomanda unde pentru a prelucra imaginea omnidirectionala este nevoie de o mare viteza si putere de calcul. Microcontrolerul Slave are in sarcina citirea tuturor senzorilor si prelucrarea primara a informatiilor furnizate de acestia. Deasemenea, fiind legat direct cu senzorii montati pe sistemul de deplasare (encodere) si cu busola acest microcontroler realizeaza programul de odometrie furnizand in permanenta pozitia reala in teren a robotului, pozitie care se transmite la fiecare ciclu de 1 secunda la telecomanda unde se afisaza permanent. A fost transferata la Telecomanda sarcina prelucrarii imaginii pentru teledirijare.

Software-ul implementat pentru coordonarea actiunilor robotului.
Pachetul software descris in continuare curprinde elementele de baza, care guverneaza operationalitatea robotului la nivelul de platforma, cuprinzand senzorii sonar si de contact, busola electronica, platforma video, actuatori pentru comutare iluminare normala si infrarosu, actionarea motoarelor motrice, procesare comenzi si informatii de la si catre telecomanda. Se face o descriere amanuntita deoarece aceste programe sunt utile oricarui robot si dorim prin aceasta sa punem la dispozitia celor care lucreaza in domeniul roboticii aceste pachete standard.
Arhitectura sistemului de calcul este compusa din doua astfel procesoare avand o frecventa de tact de 16 MHz, unul operand ca Master si celalalt Slave, intre ele existand un protocol de comunicare bidirectional propriu stabilit in functie de nevoia de prioritati. Programele care deservesc achizitia de date sunt construite modular pentru fiecare senzor in parte, iar impreuna cu protocolul de comunicati aferent comunicari intre procesoare alcatuiesc software-ul pentru procesorul Slave.

Modulele program asigurate de catre Slave:
Citire Sonare
Citire Busola
Comanda camera directionala
Citire Poziti encodere
Calculare date Odometrice
Citire nivel baterie
Citire nivel lumina ambianta
Schimbul de date si mesaje-Master-Slave

Functile asigurate de catre Master
• Receptionare date Slave
• Trimite date Slave
• Receptionare Date de la Telecomanda
• Trimite date catre Telecomanda
• Calculator Fuzzy (evitare obstacole)
• Comanda motoare
• Comenzi actuatori

3.Controler Fuzzy, bazat pe comportamente pentru navigare autonoma

3.1.Generalitati

Mediul in care opereaza robotii mobili se clasifica in -structurat -semistructurat -nestructurat. Arhitectura sistemelor de navigatie autonoma depinde atat de aplicatia robotului cat si de informatiile pe care robotul le are despre mediul in care se deplaseaza. Capabilitatea de a evita coliziunile este unul dintre principalele blocuri care intra in componenta unui robot cu posibilitati de navigatie autonoma. Implementarea unui mecanism de decizie rapida are la baza folosirea fuziunii informatiilor de la mai multi senzori. Controlul robotului bazat pe comportamente s-a dovedit a fi o alternativa de baza la controlul conventional al robotilor si serveste ca metoda de baza pentru navigatia autonoma a robotilor. Tipul de senzori cu care este dotat robotul si numarul acestora s-a decis pe baza comportamentelor pe care robotul trebuie sa le realizeze. Deasemenea s-a avut in vedere domeniul de aplicatie (cercetare in teren), timpul de prelucrare si costul total al sistemului. Ca senzori de detectie am folosit sonare avand in vedere pretul mic al acestora, structura simpla, greutatea si prelucrarea usoara a semnalelor. Fig.1.reprezinta componenta controlerului.

 



3.2 Controalele bazate pe comportamente.

Un sistem de navigatie pentru un robot mobil combina diferite comportamente ca: evitare obstacole, urmarirea unui coridor, urmarirea peretilor, cautarea(ghidarea) unei tinte, in scopul realizarii unei misiuni. Avand in vedere ca ROBO-MOCS este un robot telecomandat am prevazut ca ajutor pentru operator un regim autonom implementat printr-un controler fuzzy bazat pe comportamente (Fig.2) in care robotul se descurca singur creind timp operatorului pentru activitatea principala de culegere a informatiilor. Controlerul foloseste un numar de 4 comportamente care se descriu in continuare.

Comportamentul de pericol(evitare ciocniri).
Comportamentul de evitare obstacole.
Comportamentul de urmarire perete.
Comportamentul de ghidare la tinta.

 



3.3.Robotul, aranjamentul senzorilor si realizarea controlului bazat pe comportamente

3.3.1. Aranjament sonare

Robotul este de tip cu control diferential al directiei utilizand pentru executarea manevrelor viteze diferite pe cele doua roti motoare putand fi astfel manevrat inainte, inapoi, stanga, dreapta, intoarcere pe loc in ambele sensuri. In partea din fata sunt plasati 5 senzori sonar, unul in centru, urmatorul in stanga decalat cu 15grade, urmatorul in stanga decalat fata de centru cu 30grade, doi senzori in dreapta decalati la 15 respectiv la 30grade. Deasemenea pentru detectarea obstacolelor laterale a fost montat cate un senzor pe fiecare parte. Ca o masura redundanta de protectie pe partea din fata a robotului am montat trei senzori de contact care la ciocnirea cu un obstacol opresc brusc robotul. Senzorii au fost denumiti cu S1, S2, S3, S4, S5, Sls(senzor lateral stanga), Sld(senzor lateral dreapta), Cm(contacte mecanice).

 

3.3.2.Realizarea comportamentelor.

Comportamentele au fost implementate pe baza locului unde se afla obstacolele, determinat de sonare si a unghiului la tinta (directia de deplasare dorita) vazut de robot. Functiile de apartenenta ale intrarilor si ale iesirilor controlerului sunt date in graficele de mai jos.
Distantele la obstacole furnizate de sonarele S1 la S5 si unghiul T spre tinta sunt utilizate ca intrari pentru controlerul fuzzy care asigura comportamentele enuntate anterior.Iesirile sistemului fuzzy sunt Vlin.-viteza lineara si VUng.-viteza unghiulara a robotului.
Definirea variabilelor de intrare:

3.3.3.Stabilirea regulilor de inferenta si a metodei de defuzificare.

Robotul trebuie sa reactioneze in baza informatiilor culese despre obstacole si a directiei spre tinta de atins. Mai jos se ilustreaza spatiul din fata robotului divizat in 5 directii de detectie: -30; -15; 0; 15; 30 (grade) si 3 distante: DProt; D1-Medie; D2-Mare. In figura de mai jos se vede unde poate fi detectat un obstacol.

3.4. Implementare Software.

Inainte de a fi implementat pe microcontrolerul de navigatie a robotului Controlerul Fuzzy bazat pe comportamente a fost simulat in Matlab folosind instrumentul”Fuzzy Toolbox”. Pe scurt se prezinta in imagini modul de implementare si rezultatele simularii astfel:

3.4.1.Definirea controlerului: intrari, iesiri, tipul controler, denumire variabile si domeniul de apartenenta;
Am ales un numar de 6 intrari, constituite din sonarele S1,S2,S3,S4,S5 unde variabila Si este de tip distanta masurata cu valori cuprinse intre 0 si 5m. si Directia la tinta T definita in grade cu valori cuprinse intre -60 si +60grade, deasemenea s-au definit doua variabile de iesire, constituite din V.Lin-viteza lineara a robotului in m/s, cu valori cuprinse intre -0,4 si 1,5m/sec si V.Ung.- viteza unghiulara in rad./sec, cu valori cuprinse intre -2Rad/sec.si +2Rad./sec.Tipul controlerului, pentru usurinta implementarii pe un microcontroler, a fost ales de tip SUGENO. In figura de mai jos se vede modul de definire al controlerului Fuzzy.

 



3.4.2.Definirea si alegerea formei functiilor de apartenenta pentru variabilele de intrare si iesire.

Pentru variabilele de intrare am ales functii de apartenenta de forma triunghiulara si trapezoidala iar pentru variabilele de iesire am ales functii constante.

 

 




Variabila de intrare reprezentata de distanta la obstacol furnizata de senzorii sonar S1-S5 este constituita din 3 functii de apartenenta, doua trapezoidale si una triunghiulara, denumite Dprot, D1, D2 si avand valorile din figura de mai sus avand urmatoarea semnificatie: Dprot este zona in care distanta la obstacol este periculoasa pentru robot, reactia robotului fiind oprire si deplasare inapoi pana cand poate decide evitarea obstacolului prin ocolire; D1 este distanta medie la obstacol cu decizia robotului de evitare obstacol; D2 este distanta mare cu decizia robotului de deplasare spre tinta.
Variabila de intrare T avand semnificatia de directie spre tinta reprezinta valoarea in grade a directiei in care se afla tinta si este furnizata de operatorul care executa teledirijarea. Aceasta variabila este constituita din 3 functii de apartenenta ca in figura de mai jos cu denumirea S-stanga, C-centru, D-dreapta si cu valorile definite pe figura.

 


Variabila de iesire V.Lin-viteza lineara a robotului a fost definita ca avand 5 functii de apartenenta constante: Zero(sta pe loc)=0; Inapoi=-0,3, Mica=0,5, Medie=1, Mare=2, masurate in m/sec.ca in figura de mai jos.

 


Variabila V.Ung.- Viteza Unghiulara a robotului a fost definita ca avand 9 functii de apartenenta constante: Sfmare(stanga foarte mare)=-2; Smare(stanga mare)=-1,5; Smed(stanga medie)=-1; Smic(stanga mica)=-0,5; Z(zero)=0; Dmic(dreapta mica=0,5; Dmed(dreapta medie)=1; Dmare(dreapta mare)=1,5; Dfmare(dreapta foarte mare)=2; In figura de jos se da Functia de iesire Viteza lunghiulara.

 



3.4.3.Verificarea functionarii controlerului ;

Matlab ofera o facilitate deosebita pentru verificarea functionarii controlerului avand posibilitarea de a putea da orice valoare variabilelor de intrare, in limita domeniului de definitie si a afla pentru fiecare regula sau pe ansamblu ce valori iau variabilele de iesire. In figura de mai jos se vad 6 coloane cu variabilele de intrare, doua coloane cu variabilele de iesire, coloanele includ si functiile de apartenenta iar pe orizontala se afiseaza succesiv toate regulule stabilite si care dintre reguli este activa. Functiile de apartenenta pentru variabilele de intrare sunt afisate in galben iar cele de iesire in albastru. Se observa deosebirea intre functiile de intrare(triunghiuri si trapeze) si cele de iesire avand valori fixe,constante,controlerul fiind de tip SUGENO. Vezi figura de mai jos.

 

 

3.4.4.Afisarea grafica a dependentei variabilelor de iesire functie de valoarea variabilelor de intrare.
In graficul de mai jos se observa dependenta variabilei de iesire V.Lin. In functie de valorile detectate de sonarele 1 si 2. Este simplu de observat ca pentru distante mici sub 0,5metri(Dprot.)viteza lineara a robotului este negativa urmand ca viteza sa creasca pe masura ce obstacolele se indeparteaza.

 


Graficul de mai jos reflecta dependenta intre distantele la obstacol masurate de senzorii S1 si S3 si variatia V.ung.

 


Se observa usor ca pentru senzorul S1 care este lateral, viteza unghiulara este zero in zona de protectie si creste rapid la distanta D1 urmand ca pe masura cresterii distantei viteza sa ramana constanta. Pentru senzorul S3 fiind chiar pe directia robotului, viteza unghiulara este zero la distante mici creste cand obstacolul este in zona D1 pentru a ocoli obstacolul, si apoi la distante mari robotul merge inainte cu viteza unghiulara zero. Facand diverse combinatii intre senzorii de intrare prin aceasta reprezentare grafica am putut trage concluzia ca algoritmul functioneaza corect si robotul poate naviga intr-un teren necunoscut fara a se ciocni de obstacole fiind capabil sa ajunga singur la tinta(directia) fixata de operator.



4. Camera Omnidirectionala ca instrument de baza in teleoperarea robotului. (Echipament electronic pentru teledirijarea unui robot mobil)

Recent sistemele de vedere omnidirectionale au inceput sa fie larg utilizate in robotica.Interesul pentru astfel de sisteme a rezultat din faptul ca ele pot furniza o imagine cu un camp de vedere de 360 grade in jurul robotului.Aceasta caracteristica poate fi importanta in misiuni de navigare in care un robot trbuie sa se localizeze singur in mediul de deplasare. Sunt mai multe moduri de obtinere a imaginilor omnidirectionale video in timp real. Sistemul abordat pentru ROBO MOCS este de tip catadioptric folosind lentile, combinate cu o oglinda convexa. Sistemul este construit prin montarea unei camere in fata unei oglinzi convexe astfel incat camera sa receptioneze imaginea reflectata de oglinda. Exista diverse forme ale oglinzii convexe, cu proprietati speciale de reflexie. Oglinzile pot fi sferice, conice, parabolice, hiperbolice sau forme proiectate special. Am ales o oglinda hiperbolica avand in vedere avantajele prezentate de acest tip de oglinda, in primul rand simplitatea sistemului optic. Deoarece oglinda hiperbolica are avantajul unui singur centru de proiectie se pot crea imagini de perspectiva nedistorsionate din imaginile receptionate reflectate de oglinda hiperbolica. Aceste imagini se obtin prin maparea pixelilor din imaginea omnidirectionala intr-un plan perpendicular pe raza care trece prin centrul de proiectie. Imaginea rezultata este echivalenta cu o imagine luata de o camera de perspectiva plasata cu focarul in centrul de proiectie al sistemului de vedere. Imaginea panoramica se poate obtine cand mapam pixelii imagini omnidirectionale intr-un plan cilindric in jurul sistemului de vedere ca in figura 1.

 

 


Fig.1 Creerea imaginilor de perspectiva si panoramice



4.1. Desfasurarea(expandarea) imaginilor omnidirectionale.

Un sistem de vedere omnidirectional translateaza mediul din jurul lui intr-un sistem de coordonate polar a imaginii achizitionate.Aceasta transformare este denumita desfasurare (expandare) si este utila pentru a obtine imagini panoramice sau de perspectiva, imagini care sunt mai obisnuite pentru ochiul uman.

 



Fig.3.Exemplu de proces de expandare a imaginii OMNI pentru a obtine o imagine panoramica



Translatarea directa din coordonate polare in coordonate rectangulare.
O imagine panoramica poate fi obtinuta cand se achizitioneaza o imagine de catre un sistem de vedere catadioptric si se translateaza din coordonate polare in coordonate rectangulare. Aceasta se poate face cand unghiul azimutal in imaginea originala este translatat in axa orizontala a imaginii panoramice iar coordonatele radiale din imaginea originala este translatata in axa verticala a imaginii panoramice ca in figura 3.

4.2. Sistemul de vedere omnidirectionala OMNI-VIN.

Sistemul realizat este compus dintr-o camera cu lentile de proiectie pentru perspectiva(camera si lentile conventionale), o oglinda convexa, un ansamblu mecanic de fixare care tine camera si oglinda in pozitia corecta ca in fig 5.

Camera ce preia imagini de la oglinda paraboloidala are urmatoarele caracteristici:
- senzor CCD ½ inch - rezolutie 795(H) x 596(V) Lentile. La camera video este atasat un obiectiv varifocal cu urmatoarele caracteristici:
lentile Auto Iris, vari-focal 3.5-8mm, F1.2, montura CS mount.

Oglinda hiperbolica.

Oglinda a fost proiectata dupa o metoda originala fiind realizata pe un CNC de mare precizie si apoi slefuita pentru a obtine o imagine clara si rezolutie comparabila cu a camerei de parespectiva.

 

 


Imaginea furnizata de camera omnidirectionala

 

 


Imagine "desfasurata", panoramica



5. Telecomanda bazata pe imaginea transmisa de robot.

Pentru a realiza o teledirijare performanta am schimbat complect solutia abordata la modelul experimental renuntand la transmiterea comenzilor pe frecventa de 2400Mhz si trecand in banda de 400-500Mhz cu avantaje nete privind distanta de lucru,posibilitatea de lucru in cladiri si stabilitatea comenzilor la perturbatii.Deasemenea telecomanda a fost prevazuta cu un procesor puternic care a permis prelucrarea imaginii in scopul ajutarii operatorului cu o imagine panoramica(360grade in jurul robotului) si cu facilitate de a selecta un sector de 60 grade din imaginea panoramica spre care robotul se va indrepta.Imaginile de mai jos sunt edificatoare.

 

5.1.Schema bloc a telecomenzii



Telecomanda robotului este compusa din urmatoarele blocuri principale:

1.blocul de calcul si control care elaboreaza si trimite comenzile in functie de datele primite de la senzorii robotului;
2.blocul de comunicatie care asigura comunicarea bidirectionala de date si unidirectionala de imagini intre robot si telecomanda;
3.blocul de introducere date(Joystick);
4.blocul de afisare care permite vizualizarea comenzilor si datelor procesate de blocul de calcul si control
5.blocul de alimentare care furnizeaza tensiunile stabilizate de 12V si 5V;



5.2 Elaborarea comenzilor: joystick-ul dispune de un numar de 12 butoane folosite astfel:

1. Butonul ”CUPLARE ROBOT”(se cupleaza motoarele la microcontroller). Cand butonul”Cuplare Robot” nu este actionat robotul primeste comanda de trecere in modul RC, iar cand butonul este actionat robotul primeste comanda”Cuplare Robot” la care motoarele se cupleaza la microcontroller.
2. Butonul”CERCETARE-SUPRAVEGHERE”.
  2.1. Cercetare: Se trece in acest regim la cuplarea alimentarii Telecomenzii cand butonul CERCETARE-SUPRAV. este neactivat.
  2.2. Supraveghere: Se trece in acest regim la apasarea butonului ”Cercetare –Supraveghere”se emite codul de Supraveghere iar robotul cupleaza Camera DIR. la transmitatorul video. In acest regim operatorul poate transmite comenzi pentru platforma video prin Joystickul-V(stanga) si poate transmite comanda ‘ZOOM” prin butoanele ”Zoom-in” si “Zoom-out”. La telecomanda se afiseaza imaginea DIR.
  2.3. Butonul ”Zoom-in”, are effect de cate ori se apasa.(se poate face si cu Joystick-V)
  2.4. Butonul ”Zoom-out”, are effect de cate ori se apasa.(se poate face si cu Joystick-V)
3. Butonul ”LUMINA ALBA”: Se activeaza prin apasarea butonului “L-A”
4. Butonul ”ILUMINARE IR”: Se activeaza prin apasarea butonului ”I-IR”
5. Butonul ”AUDIO”: Se activeaza la apasare buton. Se cupleaza microfonul la TR.VIDEO iar la telecomanda incepe inregistrare sunet sau/si ascultare in difuzor.
6. Butonul ”Manual-autonom”, cand nu este apasat robotul este in regim telecomandat si asteapta comenzi de la Joystick-M. Cand butonul este actionat robotul trece in regim autonom si primeste comenzi de la Controlerul FUZZY.
7. Butonul ”Traseu impus”. Are efect cand se apasa butonul iar robotul executa programul format de operator in mesajul Traseu inpus. (se transmit perechi x, y, cu coordonatele punctelor din teren si unghiul Theta pentru schimbarea directiei.
8. Buton ”Misiune-Zoom”, are effect cand este apasat ,se comunica transmiterea directiei de deplasare(unghi) cu ajutorul Joystick-V. Directia este confirmata cu butonul Joystickului. Cand butonul nu este activat avem starea Zoom.



5.3.Afisare imagine de dirijare,imagini culese,comenzi si semnalizari primite dela robot.

5.3.1.Formatul de afisare pe ecranul telecomenzii.



5.3.2.Vizualizarea imaginilor video.

Imaginile video se obtin in regimul de supraveghere cand este cuplata camera directionala putand fi acompaniate de zgomotul sonor din proximitatea robotului.Aceasta se afiseaza in locul imaginii panoramice si va fi inregistrata pentru utilizari ulterioare.

5.3.3.Descrierea aplicatiei de vizualizare si prelucrare a imaginii omnidirectionale.

5.3.3.1.Descriere generala.

Imaginea omnidirectionala captata de la bordul robotului, de ansamblul camera video si oglinda parabolica, este transmisa la un echipament de calcul prin canal radio.
Aplicatia ImageProc asigura urmatoarele functiuni:

• Receptioneaza imaginea video transmisa de camara prin preluarea frame-urilor succesive,
• Afiseaza aceasta imagine intr-o fereastra de vizualizare,
• Transforma imaginea receptionata intr-o imagine desfasurata (unwrap) si o afiseaza intr-o alta fereastra dedicata. Imaginea aceasta va fi utila operatorului pentru evaluarea ambiantului in care evoluiaza robotul (imagine Omni).
• Permite decuparea din imaginea desfasurata a unei regiuni de interes care corespunde cu directia de deplasare a robotului. Aceasta imagine va fi utilizata pentru vizualizarea spatiului din directia de inaintare a robotului (imagine Robot).
• Asigura interactivatea cu operatorul in scopul alegerii urmatorilor parametri de prelucrare si vizualizare :
   o Selectia parametrilor geometrici ai imaginii receptionate.
   o Selectia algoritmului de interpolare utilizat,
   o Selectia zonei de interes care va fi decupata din imaginea desfasurata.

Aplicatia ImageProc necesita pentru utilizare un sistem de calcul cu sistem de operare Windows NT/XP si framework .NET 2.0. Minimum de resurse sunt : memorie RAM de 1MB, spatiu HDD 20 MB (doar in cazul in care nu se doreste si memorarea imaginilor receptionate de la camera video).

5.3.3.4.Asigurarea interactivitatii operator robot.

Aplicatia care asigura prelucrarea imaginii receptionate de la camera omnidirectionala permite si transmiterea catre robot a unor comenzi privind directia si viteza de deplasare sau actionarea unor elemente de la bordul robotului, precum si afisarea pentru operator a raportului de stare receptionat de la robot. Acest raport de stare se transmite in mod autonom fara interventia operatorului.
Pentru transmiterea de comenzi catre robot se utilizeaza o telecomanda conectata la sistemul de calcul. Comenzile generate de aceasta sunt receptionate de aplicatie si se formeaza un pachet de date care se transmite, pe canal radio, catre robot.
Informatiile de stare se transmit intr-un pachet de date care contine un raport complet al starii. Periodicitatea acestui raport este de circa 300 ms.
Aplicatia materializeaza informatiile de stare intr-o fereastra dedicata.
In mod special, in fereastra cu imaginea desfasurata, se afiseaza un reticul vertical care este pozitionat pe directia de deplasare a robotului si rezulta pe baza directiei de deplasare raportate de echipamentul de la bordul robotului.
Suprapus imaginii se afiseaza si informatii cinematice: viteza de deplasare si directia, exprimata in unghiul fata de nord.

COLECTIV DE CERCETARE:
Dr. ing. Nicolae IRIMIE
ing. Alexandru ZORILĂ
ing. Alexandru NAN
ing. Lucian SIMION
ing. Nicolae NEACŞU