Program IntroARM

From Chalmers Robotförening

Denna sida innehåller information om programmet för IntroARM. Här finns dokumentation för de specialskrivna biblioteksfunktioner som finns för IntroARM (t.ex. styra LEDs, Motorer, läsa sensorer etc). För mer allmän information om programmering av STM32, kolla på sidan Programmering STM32.

Programmet

Olika varianter av programmet hittar du här. Dessa är till för v2:
File:IntroARM kod.zip
Denna kod innehåller endast de specifika .c- och .h-filer som IntroARM använder sig av. Zip-filen innehåller ett startup-script (.S-filen) som behövs. Programmet bygger på STs standard-bibliotek som inte följer med, men som kan hittas via STs hemsida (Todo: Lägg till en länk där man hittar det). Det finns inte heller med ett länkarscript, som också behövs.

File:IntroARM Makefile Project.zip
Är ett komplett projekt med samma kod som ovan men innehåller allt som behövs för att kompilera koden under korrekt uppsatt Eclipse i Ubuntu. Detta innebär att bibilotek, länkarskript och makefil finns med. Programmet testar grundläggande funktioner som motorer, knappar, LEDs, sensorer, UART och buzzer.

File:Main start.zip
Detta är en modifierad main-fil som stödjer (till viss del) startmodulsystemet. Det som inte stöds är att den inte sparar sitt state mellan power cycles, så den måste programmeras med en ny startadress varje gång. Detta går att lösa genom att t.ex. nollställa statemaskinen via en knapptryckning (vid kanpptryckning, sätt startState till STATE_POWER) alternativt implementera att den sparas i Flash.

Parameterstyrning

Till v3 lades en funktion till för att enkelt kunna styra vilken hårdvara programmet är skrivet för. Detta anges med hjälp av parametern HARDVARE_REV filen hardwareRev.h. Denna sätts till det numret på hårdvarurevision som ska användas (2 eller 3 finns det stöd för just nu)

Generell info

Målet är att programmet ska vara uppdelat i moduler, d.v.s. att man ska kunna välja att endast använda vissa delar av programmet oberoende av andra delar. Man väljer vilken modul man ska använda genom att inkludera filen och köra init-funktionen för den.

Port-karta

Nedan följer en beskrivning på vilka portar som är kopplade till vilka funktioner på IntroARM.

Modulerna

Nedan följer en beskrivning av varje modul. En del filer kan innehålla fler än en modul, vilket gör att dessa moduler är sammankopplade. Det finns också ett antal moduler som är mycket grundläggande för IntroARMs funktion. Dessa bör alltid användas, då många funktioner beror på dessa. Detta är dels standard-peripheral-biblioteket från ST samt time-modulen

Time

Sköter funktioner som har med tid att göra. Här finns även systick-interruptet som går en gång varje ms.

  • Filer: time.c och time.h
  • Settings: Inga
  • Funktioner/Variabler:
    • delay_ms(unsigned long ms): Väntar i ms millisekunder. Under tiden den väntar är det vanliga programflödet låst och processorn svarar endast på interrupt. Mycket användbar.
    • delay_us(unsigned short us): Som delay_us, fast väntar i ett antal mikroskunder istället
    • unsigned long systemTime: Innehåller antal ms sedan processorn startade. Användbar för timings av olika slag, t.ex. timeouter.

syscalls/xprintf

Används för att få en del standard-funktionalitet, såsom printf, till IntroARM. xprintf är en samling "lättare" varianter av standardfunktionerna, men stödjer inte flyttal. Med hjälp av dessa kommer meddelandet från printf/xprintf att skrivas ut på uart1 (den som är kopplad till bootloadern). Det är självklart möjligt att ändra på funktionen _write och få den att skriva ut på någon annan UART (eller t.o.m. någon annan buss).

  • Filer: syscalls.c, syscalls.h, xprintf.c, xprintf.h, uart.c, uart.h
  • Settings: Inga
  • Funktioner:
    • printf - Standard C-funktion för att skriva ut formaterad text.
    • xprintf - Fungerar som vanliga printf, men är lite mer lättvikt och stödjer inte flyttal

LEDs

Styr de LEDs som finns på IntroARM.

  • Filer: led.c och led.h
  • Settings: Inga
  • Funktioner:
    • ledInit(): Initierar portar och klockor för LEDs. Släcker även alla LEDs.
    • Makros för varje LED: Varje LED har ett makro som använder för att styra LEDs med. Makrona heter LED_x_cmd() där x är numret på LEDen (1 till 6) och cmd är kommandot, d.v.s. SET, CLEAR eller TOGGLE. Notera att kommandot måste avslutas med ";". Exempel: LED_1_SET(); delay_ms(500); LED_1_CLEAR(); //Tänder en LED, väntar i 500ms och släcker sedan LEDen

Knappar

Hanterar knapparna för användarinput.

  • Filer: sw.c och sw.h
  • Settings: Inga
  • Funktioner:
    • swInit(): Initierar portar och klockor för knapparna. Sätter pulldown Todo: kolla så att det är korrekt
    • Makros för att läsa av knapparna: SW_x där x är numret på knappen (1 eller 2). Makrot har värdet 1 ifall knappen är nedtryckt och 0 ifall den inte är nedtryckt. Exempel: if (SW1) {do_stuff()}

UART

Styr uart-kommunikation

  • Filer:
  • Settings:
  • Funktioner:

Motor

Styr motorerna.

  • Filer: mc.c och mc.h
  • Settings:
    • MC_RIGHT_DIR och MC_LEFT_DIR ställer åt vilket håll som är "framåt" på motorerna. Dessa kan ställas till -1.0 eller 1.0 och ställs efter test av motorerna.
  • Funktioner:

Front-sensorer

Pulsar IR-LEDs och läser av status hos sensorerna. Gör viss nödvändig databehandling.

  • Filer: ir.c, ir.h
  • Settings:
    • IR_FREQ, IR_FREQ_MAX/MIN - ställer in vilken frekvens IR-LEDsen pulsas med, och därigenom vilken känsligheten på sensorerna (mottagarna är känsligast på 38kHz, och känsligheten sjunker vid andra frekvenser). Rekommenderat är att ställa IR_FREQ_MIN på 38kHz, där mottagaren är som känsligast.
    • IR_SENS_MAX - ställer in hur många steg känsligheten ska kunnas ställas in i. Vad varje steg motsvarar i Hz beräknas automatiskt i makrot IR_SENS_FREQ_STEP. Får vara max 255, men bör vara ganska lågt, runt 16.
    • IR_FILTER_MAX - ställer in hur långt lågpassfiltret för IR-sensorerna ska vara, d.v.s. hur många sampel av samma typ (1 eller 0) som krävs för att det ska räknas som att sensorn "ser".
  • Funktioner:
    • irInit() - Initierar portar, timers etc till IR-sensorerna
    • irEnable()/irDisable() - Slår på och av pulsningen av IR-LEDsen. Kan användas för att spara batteri, och skall användas i väntan på startmodul-signal
    • irSetFreq(unsigned short freq)/irSetSens(unsigned char sens) - Ställer in frekvensen (i Hz)/känsligheten för sensorerna genom att ändra pulsningsfrekvensen på LEDsen. irSetSens tar in ett värde mellan 0 och IR_SENS_MAX och anropar i sin tur irSetFreq.
    • IR_RIGHT, IR_FR_RIGHT, IR_FR_LEFT och IR_LEFT - innehåller det filtrerade värdet på hinderdetektorerna (Höger, höger fram, vänster fram, vänster). Är 1 om sensorn ser, 0 om den inte ser. Kopplade till variablerna irActiven, där n är 1-4 och motsvarar IRMOT1-4.

Exempelkod för att använda sig av hinderdetektorerna:

<syntaxhighlight lang="c" enclose="pre"> irInit(); irSetFreq(38000); irEnable(); while(1) { if(IR_RIGHT) { LED_1_SET(); } else { LED_1_CLEAR(); } if(IR_FR_RIGHT) { LED_2_SET(); } else { LED_2_CLEAR(); } if(IR_FR_LEFT) { LED_3_SET(); } else { LED_3_CLEAR(); } if(IR_LEFT) { LED_4_SET(); } else { LED_4_CLEAR(); } } </syntaxhighlight>

Fjärrkontrollavkodare (RC5)

Tar emot och avkodar meddelanden från mottagaren bak på roboten. Stödjer endast RC5 i dagsläget.

  • Filer: ir.c, ir.h, rc5.c, rc5.h, time.c, time.h
  • Resursher som används:
    • TIM6
    • PA12 + dess interrupt
  • Settings:
    • MAX_ERROR - Ställer hur mycket fel det maximalt får vara på timingen. Denna bör sättas till en delmängd av HALF_BIT_CNT.
  • Funktioner:
    • rc5Init() - initierar rc5-kommunikationen
    • rc5SetCallbackFunction(fun) - ställer in vilken funktion som ska anropas när ett meddelande är mottaget. Funktionen måste ta in en pekare till typen RC5DATA, en struct som innehåller adress och kommando från RC5. Se till att callbackfunktionen inte är för lång, eftersom denna anropas från ett interrupt.

Exempelkod för att använda sig av IR-mottagaren med fjärrkontroll:

<syntaxhighlight lang="c" enclose="pre"> void rc5Callback(*RC5DATA data);

void main () { irInit(); irDisable(); rc5Init(); rc5SetCallbackFunction(rc5Callback); }

void rc5Callback(*RC5DATA data) { unsigned char cmd = data->cmd; unsigned char adr = data->adr; if (adr == RC5_ADR_TV && cmd == RC5_CMD_1) { startRobot(); } else if (adr == RC5_ADR_TV && cmd == RC5_CMD_2) { stopRobot(); }

}

</syntaxhighlight>

Kantsensorer

Sköter ADC och läser av kantsensorerna.

  • Filer: adc.c, adc.h
  • Settings:
  • Funktioner:

Tachometrar

Sköter ADC och läser av tachometrar.

  • Filer: adc.c, adc.h, (mc.c, mc.h (för annars skulle det inte hända så mycket))
  • Settings:
  • Funktioner:

Batterimätning

Sköter ADC och mäter batterispänningen. Ger ut ett värde mellan 0 och 4096. Varje LSB motsvarar ungefär 3.2mV på batteriet. För att beräkna en vilket ADC-värde en spänning motsvarar tar du helt enkelt (spänningen i mV)/3.2 (8.4V =2625 ADC)

  • Filer: adc.c och adc.h
  • Settings:
  • Funktioner:

Buzzer

Piper buzzern i olika frekvenser. Har en viss buffert för att spela upp ljud.

  • Filer:
  • Settings:
  • Funktioner:

SD-kort

Läser och skriver data från/till SD-kortet. Kan användas för t.ex. loggning eller lagring av musik (att spela upp på buzzern)

  • Filer:
  • Settings:
  • Funktioner:

I2C

Kommunicerar med I2C.

  • Filer:
  • Settings:
  • Funktioner:

MPU6050

Gör inställningar och läser data från MPU6050 (accelerometer och gyro, x,y,z).

  • Filer: mpu6050.c, mpu6050.h, i2c.c, i2c.h
  • Settings:
  • Funktioner:

DAC (Digital-analog converter)

Skickar ut en analog spänning på en pinne.

  • Filer:
  • Settings:
  • Funktioner: