RP6 ROBOT SYSTEM - 3. Programmierung
Das Standard RP6_I2C_Slave Programm stellt 30 Register zur Verfügung, mit denen
die aktuellen Sensorwerte und Programmzustände ausgelesen werden können. Diese
sind in folgender Tabelle aufgelistet:
Registername # Beschreibung
I2C_REG_STATUS1 0 Status Register 1
Bit 0: batLow; 1: bumperLeft; 2: bumperRight;
3: RC5reception; 4: RC5transmitReady;
5: obstacleLeft; 6: obstacleRight;
7: driveSystemChange
I2C_REG_STATUS2 1 Status Register 2
Bit 0: powerOn; 1: ACSactive; 2: watchDogTimer;
3: wdtRequest; 4: wdtRequestEnable;
I2C_REG_MOTION_STATUS 2 Status Register für Antriebssystem
Bit 0: movementComplete; 1: motorsOn;
2: motorOvercurrent; 3+4: direction;
I2C_REG_POWER_LEFT 3 Aktuell eingestellter PWM Wert Links
I2C_REG_POWER_RIGHT 4 Aktuell eingestellter PWM Wert Rechts
I2C_REG_SPEED_LEFT 5 Encoder Messwert Links (Enc. Zählschritte / 200ms)
I2C_REG_SPEED_RIGHT 6 Encoder Messwert Rechts (Enc. Zählschritte / 200ms)
I2C_REG_DES_SPEED_LEFT 7 Geschwindigkeits Sollwert Links
I2C_REG_DES_SPEED_RIGHT 8 Geschwindigkeits Sollwert Rechts
I2C_REG_DIST_LEFT_L
I2C_REG_DIST_LEFT_H
9, 10Zurückgelegte Distanz Links
(High und Low Byte)
I2C_REG_DIST_RIGHT_L
I2C_REG_DIST_RIGHT_H
11,12Zurückgelegte Distanz Rechts
(High und Low Byte)
I2C_REG_ADC_LSL_L
I2C_REG_ADC_LSL_H
13, 14ADC Messwert, Lichtsensor Links
(High und Low Byte)
I2C_REG_ADC_LSR_L
I2C_REG_ADC_LSR_H
15,16ADC Messwert, Lichtsensor Rechts
(High und Low Byte)
I2C_REG_ADC_MOTOR_CURL_L
I2C_REG_ADC_MOTOR_CURL_H
17,18ADC Messwert Stromsensor Links
(High und Low Byte)
I2C_REG_ADC_MOTOR_CURR_L
I2C_REG_ADC_MOTOR_CURR_H
19,20ADC Messwert Stromsensor Rechts
(High und Low Byte)
I2C_REG_ADC_UBAT_L
I2C_REG_ADC_UBAT_H
21,22ADC Messwert Batterie Spannung
(High und Low Byte)
I2C_REG_ADC_ADC0_L
I2C_REG_ADC_ADC0_H
23,24ADC Messwert, freier ADC Kanal 0
(High und Low Byte)
I2C_REG_ADC_ADC1_L
I2C_REG_ADC_ADC1_H
25,26ADC Messwert, freier ADC Kanal 1
(High und Low Byte)
I2C_REG_RC5_ADR 27 Adresse und Togglebit des zuletzt empfangenen RC5
Datenpakets
I2C_REG_RC5_DATA 28 Daten des zuletzt empfangenen RC5 Datenpakets
I2C_REG_LEDS 29 Zustand der Status LEDs
- 21 -