Wie trigonometrische Funktionen mit dem STM32 nutzen

wie wärs denn damit?


s32 sin32fixed(s32 wink_bogen) {

  register s32 akku asm ("r9") = wink_bogen;
  register s32 potenz asm ("r10") = 0;
  register s32 square asm("r6") = 0;
  register s32 ii asm("r8") = 0;
  register s32 dummy_lo asm("r5") = 0;
  const s32 nenn_fkt_sgn [5] = {0xeaaaaaab, // (1/3!)*(2^31) dann 2er 
Komplement
                                0x01111111, // (1/5!)*(2^31-1)
                                0xFFF97F98, // (1/7!)*(2^31) dann 2er 
Komplement
                                0x0000171e, // (1/9!)*(2^31-1)
                                0xffffffca};// (1/11!)*(2^31) dann 2er 
Komplement
  // Konstantentabelle enthält Vorzeichen und Faktoren der 
Winkelpotenzen
  // also -1/3!, +1/5!, -1/7!, +1/9!, -1/11!


  potenz=akku;
  asm ("smull r5,r6,r9,r9" : "=r"(dummy_lo),"=r"(square) : 
"r"(akku),"r"(akku));

  square<<=1; // normiere
  // wink_bogen^2 ist in r6, potenz in r10 ist zunaechst wink_bogen
  akku>>=1; // da die Summation in der Schleife in einer anderen Norm 
erfolgt, muss entsprechend vorgeteilt werden
  if (akku&0x40000000) akku|=0x80000000; // Vorzeichenerweiterung
  else akku&=0x7fffffff;
  for (ii=0; ii<5; ii++) {
    //  multipliziere potenz mit wink_bogen^2
    asm ("smull r5,r10,r10,r6" : "=r"(dummy_lo),"=r"(potenz) : 
"1"(potenz),"r"(square));
    potenz<<=1; // normiere jeweils
    dummy_lo=0;  // damit sich das nicht reinaddiert
    asm ("smlal r5,r9,r10,%[rn]" : "=r"(dummy_lo),"=r"(akku) :
                                   "0"(dummy_lo),"1"(akku),"r"(potenz),[rn]"r"(nenn_fkt_sgn[ii]));
  }
  akku<<=1; // normiere Endergebnis, weil das in der Schleife nicht 
passiert
  return akku;  // gib Ergebnis zurück
}