Motorcontroller-Firmware

From Nibo

(Difference between revisions)
(Odometriestecker)
(Kommandos)
Line 7: Line 7:
! Kommando !! Größe !! Byte0 !! Byte1 !! Byte2 !! Byte3 !! Byte4
! Kommando !! Größe !! Byte0 !! Byte1 !! Byte2 !! Byte3 !! Byte4
|-
|-
-
!Stop !! 1 !! 0x00 !! - !! - !! - !! -
+
!Stop  
 +
| 1  
 +
| 0x00
 +
| -
 +
| -
 +
| -
 +
| -
|-
|-
-
!SetPWM !! 5 !! 0x01  
+
!SetPWM  
 +
| 5  
 +
| 0x01  
| colspan="2" | PWM links
| colspan="2" | PWM links
| colspan="2" | PWM rechts
| colspan="2" | PWM rechts
|-
|-
-
!SetSpeed !! 5 !! 0x02  
+
!SetSpeed  
 +
| 5  
 +
| 0x02  
| colspan="2" | Soll links
| colspan="2" | Soll links
| colspan="2" | Soll rechts
| colspan="2" | Soll rechts
|-
|-
-
!SetParameters !! 4 !! 0x03 !! Ki !! Kp !! Kd !! -
+
!SetParameters  
 +
| 4  
 +
| 0x03  
 +
| Ki  
 +
| Kp  
 +
| Kd  
 +
| -
|-
|-
-
!ResetOdometry !! 5 !! 0x04  
+
!ResetOdometry  
 +
| 5  
 +
| 0x04  
| colspan="2" | Odo links
| colspan="2" | Odo links
| colspan="2" | Odo rechts
| colspan="2" | Odo rechts

Revision as of 07:58, 2 July 2007


Write

Kommandos

Die folgenden Kommandos können über die TWI Schnittstelle zum Motorcontroller geschickt werden.

Kommando Größe Byte0 Byte1 Byte2 Byte3 Byte4
Stop 1 0x00 - - - -
SetPWM 5 0x01 PWM links PWM rechts
SetSpeed 5 0x02 Soll links Soll rechts
SetParameters 4 0x03 Ki Kp Kd -
ResetOdometry 5 0x04 Odo links Odo rechts

Zustand

Das folgende Datenpaket kann über die TWI Schnittstelle vom Motorcontroller abgefragt werden und beschreibt den aktuellen Zustand:

Größe Byte0 Byte1 Byte2 Byte3 Byte4 Byte5 Byte6 Byte7
8 Odo links Odo rechts Geschw. links Geschw. rechts
Personal tools