Subversion Repositories shark

/*

 Nome File : pxc.c

 Autore : Danilo Dealberti

          Claudio Melita

 Data : 16-11-1999

 Descrizione : modulo di implementazione delle funzioni del PXC200

 Modifiche :

*/

/*

 Note :

 Il seguente modulo permette Š in grado di supportare ogni frame grabber

 dotato del controllore single-chip Bt848/Bt848A/Bt849 della BrookTree (ora

 Conexant)

 Per variare la risoluzione di acquisizione o il formato dei dati in ingresso

 vanno variati i parametri contenuti nel seguente modulo , il quale Š

 specifico per immagini di 384x288 pixel codificate a 8 livelli di grigio

 Le modifiche possono essere effettuate consultando il manuale di descrizione del

 chip Bt848 disponibile al sito www.Conexant.com

*/

#include <kernel/func.h>

#include <sys/types.h>

#include <drivers/pci.h>

#include <drivers/pxc.h>

#include <drivers/llpci.h>

#include "../../drivers/pci/linuxpci.h"

#define appl2linear(x) (x)

// Prototipi locali

void PXC_fast(void);

void Generate_Program(DWORD *B1);

void Modify_Program(DWORD *B1);

// Variabili locali al modulo

static DWORD BaseAddr;

static BYTE IntLine;

static unsigned char *Corpo;

static unsigned char V_Corpo[7000];

static DWORD *Pun;

static DWORD Programma;

static DWORD Buffer1;

static int errore;

static PXC_Listeners Lista;

static BYTE bus,dev;

static TIME per;

static TIME Fotogramma;

static DWORD old;

static CAB Depositi;

static unsigned char *pointer;

TIME PXC_Initiate(int number) {

   struct pci_regs *reg;                  

   unsigned register int i;

   BYTE dep;

   DWORD dw;

//   MODEL m=BASE_MODEL;

//   TIME wcet;

   reg=NULL;

   if (pci_init()==1) {

      reg = (struct pci_regs *) pci_class((0x0400) << 8,0,&bus,&dev) ;

      if (reg != NULL) {

         // Ottiene l' indirizzo di base del frame grabber

         BaseAddr = (reg->IoBaseAddress-0x08); ;

         IntLine = reg->InterruptLine; // Ottiene la linea di interrupt

      } else {

         errore = 1;

         return 0;

      }

   } else {

      errore =2;

      return 0;

   }

   pcibios_read_config_dword(bus,dev,PCI_COMMAND,&dw);

   old=dw;

   dw |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER) ; // Abilita il mastering del BUS PCI e anche la mappatura in memoria

   pcibios_write_config_dword(bus,dev,PCI_COMMAND,dw);

   // Controllo della presenza di video input

   dep = (BYTE) lmempeekb((void *)(BaseAddr+PXC_DSTATUS));

   if (dep & 0x80) {

     // Creazione del CAB in base al numero di processi interessati

     Depositi = cab_create("",PXC_MAXX*PXC_MAXY*sizeof(unsigned char),number+2);

     if (Depositi<0) return 0;

      // Autoformat detected enabled

      lmempokeb((void *)(BaseAddr+PXC_IOFORM),0x58);

      // Fattore di scala orizzontale 2:1

      lmempokeb((void *)(BaseAddr+ PXC_E_HSCALE_HI),0x16);

      lmempokeb((void *)(BaseAddr+ PXC_E_HSCALE_LO),0x79);

      lmempokeb((void *)(BaseAddr+ PXC_O_HSCALE_HI),0x16);

      lmempokeb((void *)(BaseAddr+ PXC_O_HSCALE_LO),0x79);

      // Fattore di scala verticale 1:1

      lmempokeb((void *)(BaseAddr+ PXC_E_VSCALE_HI),0x60);

      lmempokeb((void *)(BaseAddr+ PXC_E_VSCALE_LO),0);

      lmempokeb((void *)(BaseAddr+ PXC_O_VSCALE_HI),0x60);

      lmempokeb((void *)(BaseAddr+ PXC_O_VSCALE_LO),0);

      // Numero di pixel orizzontali formanti l'immagine

      lmempokeb((void *)(BaseAddr+ PXC_E_HACTIVE_LO),0x80);

      lmempokeb((void *)(BaseAddr+ PXC_O_HACTIVE_LO),0x80);

      // Numero di pixel verticali formanti l'immagine

      lmempokeb((void *)(BaseAddr+ PXC_E_VACTIVE_LO),0x40);

      lmempokeb((void *)(BaseAddr+ PXC_O_VACTIVE_LO),0x40);

      // Temporizzazione verticale

      lmempokeb((void *)(BaseAddr+ PXC_E_VDELAY_LO),0x20);

      lmempokeb((void *)(BaseAddr+ PXC_O_VDELAY_LO),0x20);

      // Tempozizzazione Orizzontale

      lmempokeb((void *)(BaseAddr+ PXC_E_HDELAY_LO),0x4d);

      lmempokeb((void *)(BaseAddr+ PXC_O_HDELAY_LO),0x4d);

      // Parte alta di VACTIVE HACTIVE VDELAY HDELAY

      lmempokeb((void *)(BaseAddr+ PXC_E_CROP), 0x21);

      lmempokeb((void *)(BaseAddr+ PXC_O_CROP),0x21);

      // Temporizzazione del convertitore ADC e del periodo di burst

      lmempokeb((void *)(BaseAddr+ PXC_ADELAY),0x7f);

      lmempokeb((void *)(BaseAddr+ PXC_BDELAY),0x72);

      // Setta l'acquisizione a 8 livelli di grigio

      lmempokeb((void *)(BaseAddr+ PXC_COLOR_FMT), 0x66);

      // Generazione del programma nel buffer ottenuto dal CAB

      pointer = cab_reserve(Depositi);

      Generate_Program((DWORD *)pointer);

     // Cattura Full-Frame , sia even che odd field

     lmempokeb((void *)(BaseAddr+PXC_CAP_CTL),0x13);

     // Abilitazione delle interruzioni

     lmempoked((void *)(BaseAddr+PXC_INT_MASK),0x00001800);

     // Inserimento dell' indirizzo del programma RISC all' interno del

     // canale DMA

     lmempoked((void *)(BaseAddr+PXC_RISC_STRT_ADD),Programma);

     } else {

         errore=3;

         return 0;

     }

     // Inizializzazione della struttura dati utilizzata per

     // aggiungere processi ascoltatori dell' immagine

    for(i=0;i<PXC_MAX_LISTENERS;i++) {

         Lista.Elementi[i].proc=NIL;

         Lista.Elementi[i].DRel = 0;

    }

    Lista.Top=0;

    per = PXC_FRAME_TIME; // Ritorno periodo in us

    Fotogramma=0;

    return per;

}

/**************************************************************************/

void PXC_Start(void) {

   handler_set(IntLine, (void (*)(int))PXC_fast, NIL);

   lmempokew((void *)(BaseAddr+PXC_GPIO_DMA_CTL),0x0000);

   lmempokew((void *)(BaseAddr+PXC_GPIO_DMA_CTL),0x0003);

}

/**************************************************************************/

int PXC_Push_Listener(PID l, int drel)

{

   int pele;

   if (l == NIL) return 0;

   if (Lista.Top == PXC_MAX_LISTENERS) {

      errore=4;

      return 0; // Non vi sono pi— elementi liberi

   }

   pele = Lista.Top;

   Lista.Top++;

 // Setta tutto ci• che serve per il nuovo elemento

   Lista.Elementi[pele].proc=l;

   Lista.Elementi[pele].DRel = drel;

   return 1;

}

/**************************************************************************/

int PXC_Pop_Listener()

{

   if (Lista.Top > 0) {

      Lista.Top --;

      return 1;

   }

   return 0;

}

/**************************************************************************/

void PXC_Close(void)

{

//   DWORD dw;

 // Ferma il DMA

   lmempokew((void *)(BaseAddr+PXC_GPIO_DMA_CTL),0x0000);

   pcibios_write_config_dword(bus,dev,PCI_COMMAND,old);

   handler_remove(IntLine);

   for(;PXC_Pop_Listener();) ; // Li toglie tutti

   // Rimozione del CAB

   cab_delete(Depositi);

}

/*************************************************************************/

void PXC_fast(void) {

   DWORD pen;

   register int i;

   pen=lmempeekd((void *)(BaseAddr+PXC_INT_STAT));

   if (pen & 0x00000800) {

         // COMMIT al CAB

      cab_putmes(Depositi,pointer);

      // Interrompi il programma RISC

      lmempokew((void *)(BaseAddr+PXC_GPIO_DMA_CTL),0x0000);

      // Crea il nuovo programma in memoria dopo aver riservato il nuovo

      // CAB

      pointer=cab_reserve(Depositi);

      Modify_Program((DWORD *)pointer);

      // Riabilita il programma

      lmempokew((void *)(BaseAddr+PXC_GPIO_DMA_CTL),0x0003);

      Fotogramma++;

      // Attivazione dei task nel fast handler direttamente, visto il suo

      // tempo di esecuzione molto ridotto (decine di microsec contro un

      // interrupt period di 20 millisec )

      for(i=0;i<Lista.Top;i++)

         if (!(Fotogramma % Lista.Elementi[i].DRel)) {

           LEVEL l;

           PID p = Lista.Elementi[i].proc;

           if (proc_table[p].control & FREEZE_ACTIVATION)

             proc_table[p].frozen_activations++;

           else {

             l = proc_table[p].task_level;

             level_table[l]->public_activate(l,p);

             event_need_reschedule();

           }

//           task_activate(Lista.Elementi[i].proc);

         }

    } else {

  // C'Š un errore nell' acquisizione, per ora non lo trattiamo

    }

    lmempoked((void *)(BaseAddr+PXC_INT_STAT),pen); // EOI al Bt848

}

/*************************************************************************/

void Generate_Program(DWORD *B1)

{

 unsigned register int i;

      // Definizione del programma all' interno dello spazio di memoria puntato

      // da Programma , va DWORD aligned , quindi prima lo allineamo, poi

      // andiamo a scriverci dentro il programma, il quale pu• essere variabile

      // in funzione delle opzioni di ingresso

      Corpo = V_Corpo;

      Programma = appl2linear(Corpo);

      if (Programma % 4) {

         unsigned char diff;

        // Procediamo all' allineamento del buffer

         diff = (unsigned char)(((Programma / 4)+1) * 4 -Programma);

         Programma += diff;

         Corpo += diff;  // Anche il puntatore del buffer va aumentato

      }

      // Si innesca sempre da qui

      Pun = (DWORD *) Corpo;

      Buffer1 = appl2linear(B1);

      //Buffer2 = appl2linear(B2);

      (*Pun)=PXC_SYNC | PXC_FM1 ;

      Pun++;

      (*Pun)=0;

      for(i=0;i< PXC_MAXY;i++)

      {

         Pun++;

         (*Pun) = PXC_WRITE | PXC_SET_SOL | PXC_SET_EOL | PXC_MAXX ;

         Pun++;

         (*Pun)=(Buffer1+ i* PXC_MAXX);

      }

      Pun++;

      (*Pun) = PXC_SYNC | PXC_VRE | PXC_SET_IRQ ;

      Pun++;

      (*Pun) = 0;

      Pun++;

      (*Pun) = PXC_SYNC | PXC_FM1   ;

      Pun++;

      (*Pun) = 0;

      // Write mettendo SOL e EOL e come byte count 768 , come indirizzo

      // quello del buffer per il campo dispari

      for(i=0; i<PXC_MAXY; i++) {

         Pun++;

         (*Pun) = PXC_WRITE | PXC_SET_SOL | PXC_SET_EOL | PXC_MAXX ;

         Pun++;

         (*Pun)=(/*Buffer2*/Buffer1+i*PXC_MAXX);

      }

      Pun++;

      (*Pun) = PXC_SYNC | PXC_VRO ;

      Pun++;

      (*Pun)=0;

      // Jump all' indirizzo contenuto in programma e interrupt

      Pun++;

      (*Pun) = PXC_JUMP | PXC_SET_IRQ ;

      Pun++;

      (*Pun) = Programma;

     // Fine programma di istruzione del RISC DMA channels

}

/*********************************************************************/

void Modify_Program(DWORD *B1)

{

 unsigned register int i;

      // Si innesca sempre da qui

      Pun = (DWORD *) Corpo;

      Buffer1 = appl2linear(B1);

      Pun++;

      for(i=0;i< PXC_MAXY;i++)

      {

         Pun+=2;

         (*Pun)=(Buffer1+ i* PXC_MAXX);

      }

      Pun+=4;

      for(i=0; i<PXC_MAXY; i++) {

         Pun+=2;

         (*Pun)=(Buffer1+i*PXC_MAXX);

      }

     // Fine programma di istruzione del RISC DMA channels

}

/****************************************************************************/

CAB PXC_GetCab(void)

{

 return Depositi;

}