Wie auf Float verzichten?

[Stm M. (stmfresser)]

Hallo,

ich programmiere einen STM32F103C Mikrocontroller. Ich habe eine ISR 
Funktion, die mit 60µs Takt aufgerufen wird. Da der STM32F1 keinen FPU 
hat, möchte ich die paar Gleitkomma Berechnungen mit Shifts realisieren, 
klappt leider nicht.


Die Implementierung mit Float:

volatile float angle_vel_L = 0.0f;
void angleEstimate_L(void) {
  float angle_pL = angle_L + angle_vel_L * 0.000064f;

  float measured_angle_L = (float) ((hallCounterL << 6) - (hallCounterL << 2));

  float errAngle_L = measured_angle_L - angle_pL;
  angle_L = angle_pL + 0.03340962f * errAngle_L;
  angle_vel_L += 0.05676238f * errAngle_L;

}

mit Integer:

#define SCALE 28

volatile int angle_L = 0;
volatile int angle_vel_L = 0;
void angleEstimate_L(void) {
  int angle_pL = angle_L + (angle_vel_L >> 14);
  int measured_angle_L = ((hallCounterL << 6) - (hallCounterL << 2)) << SCALE;

  int errAngle_L = measured_angle_L - angle_pL;
  angle_L = angle_pL + (errAngle_L >> 5);
  angle_vel_L += (errAngle_L >> 4);

}

int getAngle(void) {
    return angle_L >> SCALE;
}

Weiß jemand vielleicht wo der Fehler liegt.

Vielen Dank im Voraus.

[Mampf F. (mampf)]

Hmm, das mit dem Schieben erscheint mir seltsam ...

Normalerweise einigt man sich (mit sich selbst^^) auf die Anzahl der 
Bits von Vor- und Nachkomma.

Bei 32Bit beispielsweise 24.8

Dann konvertiert man die Konstanten zB 0.000064 * 2^8 und stellt fest, 
dass das schon mal nicht ausreicht ;-)

Bei dir waren 28Bit Vorkomma? Dann blieben 4Bit Nachkomma übrig ...

Also kein Wunder, dass das nicht funktioniert.

Nächster Versuch: 16.16 ... 0.000064 * 65536 = 4,19 ...

Das ginge gerade so ...

[Jim M. (turboj)]

Stm M. schrieb:

> #define SCALE 28
> [...]
> int measured_angle_L = ((hallCounterL << 6) - (hallCounterL << 2)) <<
> SCALE;


Bis Du Dir sicher dass Du da innerhalb der 31 Bits (Vorzeichen!) 
bleibst? Sieht für mich nämlich nicht danach aus. Und: Der Überlauf ins 
Vorzeichenbit ist in C nicht definiert.

[Stm M. (stmfresser)]

Vielen Dank.

Ich hab in meinem Leichtsinn davon ausgegangen dass der Überlauf nicht 
gleich auftritt. ^^