Ignore:
Timestamp:
Jun 13, 2003, 5:40:41 PM (17 years ago)
Author:
Joel Sherrill <joel.sherrill@…>
Children:
641fb28
Parents:
7a848b40
Message:

2003-06-13 Greg Menke <gregory.menke@…>

PR 405/bsps

  • bootloader/pci.c: Added support for configuring devices for pci busses > 0
  • pci/pci.c, pci/pci.h: Added FixupPCI() to store vectors in the INTERRUPT_LINE register of pci devices any # of hops away from the host processor.
  • motorola/motorola.c, motorola/motorola.h: Added interrupt routing tables in support of FixupPCI. This is board-specific, each board will have to supply information for FixupPCI() to do anything for it.
  • startup/bspstart.c: Extended bat2 to cover entire PCI address space.
  • irq/irq.c, irq/irq.h: Added support for shared interrupts. Existing single hander vectors are undisturbed, a new function added to allow adding/removing handlers from a vector.
File:
1 edited

Legend:

Unmodified
Added
Removed
  • c/src/lib/libbsp/powerpc/shared/irq/irq.c

    r7a848b40 r12838559  
    119119}
    120120
     121
     122/*
     123 * ------------------------ RTEMS Shared Irq Handler Mngt Routines ----------------
     124 */
     125int BSP_install_rtems_shared_irq_handler  (const rtems_irq_connect_data* irq)
     126{
     127    unsigned int level;
     128    rtems_irq_connect_data* vchain;
     129 
     130    if (!isValidInterrupt(irq->name)) {
     131      printk("Invalid interrupt vector %i\n",irq->name);
     132      return 0;
     133    }
     134    if ( (int)rtems_hdl_tbl[irq->name].next_handler  == -1 ) {
     135      printk("IRQ vector %i already connected to an unshared handler\n",irq->name);
     136      return 0;
     137    }
     138    _CPU_ISR_Disable(level);
     139
     140
     141     vchain = (rtems_irq_connect_data*)malloc(sizeof(rtems_irq_connect_data));
     142
     143    /* save off topmost handler */
     144    vchain[0]= rtems_hdl_tbl[irq->name];
     145   
     146    /*
     147     * store the data provided by user
     148     */
     149    rtems_hdl_tbl[irq->name] = *irq;
     150
     151    /* link chain to new topmost handler */
     152    rtems_hdl_tbl[irq->name].next_handler = (void *)vchain;
     153
     154   
     155    if (is_isa_irq(irq->name)) {
     156      /*
     157       * Enable interrupt at PIC level
     158       */
     159      BSP_irq_enable_at_i8259s (irq->name);
     160    }
     161   
     162    if (is_pci_irq(irq->name)) {
     163      /*
     164       * Enable interrupt at OPENPIC level
     165       */
     166      openpic_enable_irq ((int) irq->name - BSP_PCI_IRQ_LOWEST_OFFSET);
     167    }
     168
     169    if (is_processor_irq(irq->name)) {
     170      /*
     171       * Enable exception at processor level
     172       */
     173    }
     174    /*
     175     * Enable interrupt on device
     176     */
     177    irq->on(irq);
     178   
     179    _CPU_ISR_Enable(level);
     180
     181    return 1;
     182}
     183
     184
    121185/*
    122186 * ------------------------ RTEMS Single Irq Handler Mngt Routines ----------------
     
    148212     */
    149213    rtems_hdl_tbl[irq->name] = *irq;
     214    rtems_hdl_tbl[irq->name].next_handler = (void *)-1;
    150215   
    151216    if (is_isa_irq(irq->name)) {
     
    190255int BSP_remove_rtems_irq_handler  (const rtems_irq_connect_data* irq)
    191256{
     257   rtems_irq_connect_data *pchain= NULL, *vchain = NULL;
    192258    unsigned int level;
    193259 
     
    207273    _CPU_ISR_Disable(level);
    208274
     275    if( (int)rtems_hdl_tbl[irq->name].next_handler != -1 )
     276    {
     277       int found = 0;
     278
     279       for( (pchain= NULL, vchain = &rtems_hdl_tbl[irq->name]);
     280            (vchain->hdl != default_rtems_entry.hdl);
     281            (pchain= vchain, vchain = (rtems_irq_connect_data*)vchain->next_handler) )
     282       {
     283          if( vchain->hdl == irq->hdl )
     284          {
     285             found= -1; break;
     286          }
     287       }
     288
     289       if( !found )
     290       {
     291          _CPU_ISR_Enable(level);
     292          return 0;
     293       }
     294    }
     295    else
     296    {
     297       if (rtems_hdl_tbl[irq->name].hdl != irq->hdl)
     298       {
     299          _CPU_ISR_Enable(level);
     300         return 0;
     301       }
     302    }
     303
    209304    if (is_isa_irq(irq->name)) {
    210305      /*
     
    233328     * restore the default irq value
    234329     */
    235     rtems_hdl_tbl[irq->name] = default_rtems_entry;
     330    if( !vchain )
     331    {
     332       /* single handler vector... */
     333       rtems_hdl_tbl[irq->name] = default_rtems_entry;
     334    }
     335    else
     336    {
     337       if( pchain )
     338       {
     339          /* non-first handler being removed */
     340          pchain->next_handler = vchain->next_handler;
     341       }
     342       else
     343       {
     344          /* first handler isn't malloc'ed, so just overwrite it.  Since
     345          the contents of vchain are being struct copied, vchain itself
     346          goes away */
     347          rtems_hdl_tbl[irq->name]= *vchain;
     348       }
     349       free(vchain);
     350    }
    236351
    237352    _CPU_ISR_Enable(level);
     
    266381    for (i=BSP_ISA_IRQ_LOWEST_OFFSET; i < BSP_ISA_IRQ_LOWEST_OFFSET + BSP_ISA_IRQ_NUMBER; i++) {
    267382      if (rtems_hdl_tbl[i].hdl != default_rtems_entry.hdl) {
    268         BSP_irq_enable_at_i8259s (i);
    269         rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]);
     383         BSP_irq_enable_at_i8259s (i);
     384
     385         /* rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]); */
     386         {
     387            rtems_irq_connect_data* vchain;
     388            for( vchain = &rtems_hdl_tbl[i];
     389                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     390                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     391            {
     392               vchain->on(vchain);
     393            }
     394         }
    270395      }
    271396      else {
    272         rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]);
    273         BSP_irq_disable_at_i8259s (i);
     397         /* rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]); */
     398         {
     399            rtems_irq_connect_data* vchain;
     400            for( vchain = &rtems_hdl_tbl[i];
     401                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     402                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     403            {
     404               vchain->off(vchain);
     405            }
     406         }
     407         BSP_irq_disable_at_i8259s (i);
    274408      }
    275409    }
     
    288422                                  internal_config->irqPrioTbl[i]);
    289423      if (rtems_hdl_tbl[i].hdl != default_rtems_entry.hdl) {
    290         openpic_enable_irq ((int) i - BSP_PCI_IRQ_LOWEST_OFFSET);
    291         rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]);
     424         openpic_enable_irq ((int) i - BSP_PCI_IRQ_LOWEST_OFFSET);
     425         /* rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]); */
     426         {
     427            rtems_irq_connect_data* vchain;
     428            for( vchain = &rtems_hdl_tbl[i];
     429                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     430                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     431            {
     432               vchain->on(vchain);
     433            }
     434         }
     435
    292436      }
    293437      else {
    294         rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]);
    295         openpic_disable_irq ((int) i - BSP_PCI_IRQ_LOWEST_OFFSET);
     438         /* rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]); */
     439         {
     440            rtems_irq_connect_data* vchain;
     441            for( vchain = &rtems_hdl_tbl[i];
     442                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     443                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     444            {
     445               vchain->off(vchain);
     446            }
     447         }
     448         
     449         openpic_disable_irq ((int) i - BSP_PCI_IRQ_LOWEST_OFFSET);
    296450      }
    297451    }
     
    305459    for (i=BSP_PROCESSOR_IRQ_LOWEST_OFFSET; i < BSP_PROCESSOR_IRQ_LOWEST_OFFSET + BSP_PROCESSOR_IRQ_NUMBER; i++) {
    306460      if (rtems_hdl_tbl[i].hdl != default_rtems_entry.hdl) {
    307         rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]);
     461         /* rtems_hdl_tbl[i].on(&rtems_hdl_tbl[i]); */
     462         {
     463            rtems_irq_connect_data* vchain;
     464            for( vchain = &rtems_hdl_tbl[i];
     465                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     466                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     467            {
     468               vchain->on(vchain);
     469            }
     470         }
     471
    308472      }
    309473      else {
    310         rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]);
     474         /* rtems_hdl_tbl[i].off(&rtems_hdl_tbl[i]); */
     475         {
     476            rtems_irq_connect_data* vchain;
     477            for( vchain = &rtems_hdl_tbl[i];
     478                 ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     479                 vchain = (rtems_irq_connect_data*)vchain->next_handler )
     480            {
     481               vchain->off(vchain);
     482            }
     483         }
     484
    311485      }
    312486    }
     
    374548  _CPU_MSR_SET(new_msr);
    375549   
    376   rtems_hdl_tbl[irq].hdl();
     550  /* rtems_hdl_tbl[irq].hdl(); */
     551  {
     552     rtems_irq_connect_data* vchain;
     553     for( vchain = &rtems_hdl_tbl[irq];
     554          ((int)vchain != -1 && vchain->hdl != default_rtems_entry.hdl);
     555          vchain = (rtems_irq_connect_data*)vchain->next_handler )
     556     {
     557        vchain->hdl();
     558     }
     559  }
     560
    377561
    378562  _CPU_MSR_SET(msr);
Note: See TracChangeset for help on using the changeset viewer.