workbench/devs/AHI/Drivers/ac97/ac97-playslave.c

   1 #define DEBUG 0
   2 #include <aros/debug.h>
   3 #include <asm/io.h>
   4
   5 #include <config.h>
   6
   7 #include <devices/ahi.h>
   8 #include <libraries/ahi_sub.h>
   9
  10 #include "DriverData.h"
  11 #include "library.h"
  12
  13 #define dd ((struct AC97Data *) AudioCtrl->ahiac_DriverData)
  14
  15 /******************************************************************************
  16 ** The slave process **********************************************************
  17 ******************************************************************************/
  18
  19 #undef SysBase
  20
  21 void Slave( struct ExecBase* SysBase );
  22
  23 #if defined( __AROS__ )
  24
  25 #include <aros/asmcall.h>
  26
  27 AROS_UFH3(LONG, SlaveEntry,
  28           AROS_UFHA(STRPTR, argPtr, A0),
  29           AROS_UFHA(ULONG, argSize, D0),
  30           AROS_UFHA(struct ExecBase *, SysBase, A6))
  31 {
  32    AROS_USERFUNC_INIT
  33    Slave( SysBase );
  34    AROS_USERFUNC_EXIT
  35 }
  36
  37 #else
  38
  39 void SlaveEntry(void)
  40 {
  41   struct ExecBase* SysBase = *((struct ExecBase**) 4);
  42
  43   Slave( SysBase );
  44 }
  45 #endif
  46
  47 struct BufferDescriptor {
  48     APTR    pointer;
  49     ULONG   length;
  50 };
  51
  52 void
  53 Slave( struct ExecBase* SysBase )
  54 {
  55   struct AHIAudioCtrlDrv* AudioCtrl;
  56   struct DriverBase*      AHIsubBase;
  57   struct ac97Base*        ac97Base;
  58   BOOL                    running, firstTime = TRUE;
  59   ULONG                   signals;
  60
  61   AudioCtrl  = (struct AHIAudioCtrlDrv*) FindTask( NULL )->tc_UserData;
  62   AHIsubBase = (struct DriverBase*) dd->ahisubbase;
  63   ac97Base   = (struct ac97Base*) AHIsubBase;
  64
  65   dd->slavesignal = AllocSignal( -1 );
  66
  67
  68 //    outb(0x1e, ac97Base->dmabase + PO_CR);
  69 //    outl(ac97Base->PCM_out, ac97Base->dmabase + PO_BDBAR);
  70
  71 D(bug("SR=%04x CR=%04x CIV=%02x LVI=%02x\n", inw(ac97Base->dmabase + ac97Base->off_po_sr),
  72     inw(ac97Base->dmabase + PO_CR),
  73     inb(ac97Base->dmabase + PO_CIV),
  74     inb(ac97Base->dmabase + PO_LVI)));
  75
  76   if( dd->slavesignal != -1 )
  77   {
  78     // Everything set up. Tell Master we're alive and healthy.
  79
  80     Signal( (struct Task*) dd->mastertask,
  81             1L << dd->mastersignal );
  82
  83     running = TRUE;
  84
  85     SetTaskPri(FindTask(NULL), 127);
  86
  87     int tail = (inb(ac97Base->dmabase + PO_CIV) + 1) & 0x1f;
  88
  89     while( running )
  90     {
  91       signals = SetSignal(0L,0L);
  92
  93
  94       if( signals & ( SIGBREAKF_CTRL_C | (1L << dd->slavesignal) ) )
  95       {
  96         running = FALSE;
  97       }
  98       else
  99       {
 100           int i,j;
 101           IPTR buff;
 102         CallHookPkt( AudioCtrl->ahiac_PlayerFunc, AudioCtrl, NULL );
 103         CallHookPkt( AudioCtrl->ahiac_MixerFunc, AudioCtrl, dd->mixbuffer );
 104
 105         i = AudioCtrl->ahiac_BuffSamples << 1;
 106     i <<= ac97Base->size_shift; /* For SIS 7012 size must be in bytes */
 107         j = tail;
 108         buff = dd->mixbuffer;
 109
 110         while (i > 0)
 111         {
 112             ac97Base->PCM_out[j].sample_address = buff;
 113             ac97Base->PCM_out[j].sample_size = (i > 65532) ? 65532 : i;
 114
 115             i -= ac97Base->PCM_out[j].sample_size;
 116             buff += ac97Base->PCM_out[j].sample_size
 117                     << (1 - ac97Base->size_shift); /* SIS 7012: size already in bytes */
 118             j++;
 119             tail++;
 120             tail &= 0x1f;
 121             j &= 0x1f;
 122         }
 123         ac97Base->PCM_out[(j-1) & 0x1f].sample_size |= 0x80000000;
 124 /*
 125         D(bug("playing audio from %x (size %d, buffer %d)\n",
 126             dd->mixbuffer, AudioCtrl->ahiac_BuffSamples, j-1));
 127
 128         D(bug("SR=%08x ",inl(ac97Base->dmabase + PO_CIV)));
 129 */
 130 //      outw(4, ac97Base->dmabase + ac97Base->off_po_sr);
 131         outb((j-1) & 0x1f, ac97Base->dmabase + PO_LVI);
 132         if (firstTime)
 133         {
 134             outb(0x11, ac97Base->dmabase + PO_CR);
 135                 /* Enable busmaster + interrupt on completion */
 136             firstTime = FALSE;
 137         }
 138
 139 //      outw(0x1c, ac97Base->dmabase + ac97Base->off_po_sr);
 140 //      D(bug("SR=%04x ",inw(ac97Base->dmabase + ac97Base->off_po_sr)));
 141 //      while (!(inw(ac97Base->dmabase + ac97Base->off_po_sr) & 8)) {
 142 //          D(bug("SR=%04x ",inw(ac97Base->dmabase + ac97Base->off_po_sr)));
 143
 144     D(bug("Waiting for int..."));
 145     Wait(SIGBREAKF_CTRL_E);
 146     D(bug("Got it\n"));
 147
 148 //       }
 149 //      D(bug("SR=%04x\n",inw(ac97Base->dmabase + ac97Base->off_po_sr)));
 150 //        outw(inw(ac97Base->dmabase + ac97Base->off_po_sr), ac97Base->dmabase + ac97Base->off_po_sr);
 151
 152 //      ac97Base->PCM_out
 153         // The mixing buffer is now filled with AudioCtrl->ahiac_BuffSamples
 154         // of sample frames (type AudioCtrl->ahiac_BuffType). Send them
 155         // to the sound card here.
 156       }
 157     }
 158   }
 159
 160   outb(0, ac97Base->dmabase + PO_CR);
 161   FreeSignal( dd->slavesignal );
 162   dd->slavesignal = -1;
 163
 164   Forbid();
 165
 166   // Tell the Master we're dying
 167
 168   Signal( (struct Task*) dd->mastertask,
 169           1L << dd->mastersignal );
 170
 171   dd->slavetask = NULL;
 172
 173   // Multitasking will resume when we are dead.
 174 }
 175