STM32F4 Filter function

[Martin H. (disjunction)]

Ich möchte eine Function für das automatische Einstellen der Filter 
erstellen. Ich habe dafür das CAN Beispiel vom Discovery Bard 
modifiziert.
Eine Variante habe ich für 32 Bit Filter angefangen. Variante 2 soll 
auch für 16 Bit Filter funktioniern.

void CAN_wrFilter (uint32_t ctrl, uint32_t id, uint32_t mask, uint8_t format)  {
   CAN_TypeDef *pCAN = (ctrl == 1) ? CAN1 : CAN2;
   uint32_t      CAN_msgId     = 0;
   uint32_t      CAN_msgMask   = 0;
  
  if ((mask != 0) && (CAN_filterRegisterIdx != 0)) {   
    CAN_filterIdx[ctrl-1]++;
  }                                                 /* increase filter index  */

  if (CAN_filterIdx[ctrl-1] > 13) {                 /* check if Filter Memory is full*/
    return;
  }

                                            /* Setup identifier information  IDE BIT */  
  if (format == STANDARD_FORMAT)  {         /*   Standard ID                 */
      CAN_msgId   |= (uint32_t)(id << 21) | CAN_ID_STD;
      CAN_msgMask  = (uint32_t)(mask << 21); 
  }  else  {                                /*   Extended ID                 */
      CAN_msgId   |= (uint32_t)(id <<  3) | CAN_ID_EXT;
      CAN_msgMask  = (uint32_t)(mask << 3);
  }

  pCAN->FMR  |=   CAN_FMR_FINIT;                    /* set  InitMode for filter banks */
  pCAN->FA1R &=  ~(1UL << CAN_filterIdx[ctrl-1]);   /* deactivate filter              */

  pCAN->FS1R |=  (uint32_t)(1 << CAN_filterIdx[ctrl-1]);     /* set 32-bit scale configuration    */


  if  (mask == 0)  {                                          /* FBMx Bit  Identifier List mode     */ 
    pCAN->FM1R |= (uint32_t)(1 << CAN_filterIdx[ctrl-1]);     /* set to 32-bit Identifier List mode */
    if (CAN_filterRegisterIdx = 0) 
      pCAN->sFilterRegister[CAN_filterIdx[ctrl-1]].FR1 = CAN_msgId;   /*  32-bit identifier   */
    else
      pCAN->sFilterRegister[CAN_filterIdx[ctrl-1]].FR2 = CAN_msgId;    /*  32-bit identifier   */
  }  else {  
    pCAN->FM1R &= ~(uint32_t)(1 << CAN_filterIdx[ctrl-1]);    /* set to 32-bit Mask mode */
    if (CAN_filterRegisterIdx = 0) 
      pCAN->sFilterRegister[CAN_filterIdx[ctrl-1]].FR1 = CAN_msgId;   /*  32-bit identifier   */
    else
      pCAN->sFilterRegister[CAN_filterIdx[ctrl-1]].FR2 = CAN_msgMask;    /*  32-bit identifier   */
    CAN_filterRegisterIdx++;
  }

  
  
  CAN_filterRegisterIdx++;
  
  pCAN->FFA1R &= ~(uint32_t)(1 << CAN_filterIdx[ctrl-1]);   /* assign filter to FIFO 0  */
  pCAN->FA1R  |=  (uint32_t)(1 << CAN_filterIdx[ctrl-1]);   /* activate filter          */
  
  pCAN->FMR &= ~CAN_FMR_FINIT;              /* reset initMode for filterBanks*/
                    
}

[/c]

[Uwe Bonnes (Gast)]

Fuer Ethernut unter nut/arch/cm3/dev/stm/stm32_can.c habe ich ein 
CanAddFilter() Funktion geschreiben. Vielleicht hilfts weiter...