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

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