maestro3.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:86k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*****************************************************************************
  2.  *
  3.  *      ESS Maestro3/Allegro driver for Linux 2.4.x
  4.  *
  5.  *      This program is free software; you can redistribute it and/or modify
  6.  *      it under the terms of the GNU General Public License as published by
  7.  *      the Free Software Foundation; either version 2 of the License, or
  8.  *      (at your option) any later version.
  9.  *
  10.  *      This program is distributed in the hope that it will be useful,
  11.  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13.  *      GNU General Public License for more details.
  14.  *
  15.  *      You should have received a copy of the GNU General Public License
  16.  *      along with this program; if not, write to the Free Software
  17.  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18.  *
  19.  *    (c) Copyright 2000 Zach Brown <zab@zabbo.net>
  20.  *
  21.  * I need to thank many people for helping make this driver happen.  
  22.  * As always, Eric Brombaugh was a hacking machine and killed many bugs
  23.  * that I was too dumb to notice.  Howard Kim at ESS provided reference boards 
  24.  * and as much docs as he could.  Todd and Mick at Dell tested snapshots on 
  25.  * an army of laptops.  msw and deviant at Red Hat also humoured me by hanging
  26.  * their laptops every few hours in the name of science.
  27.  * 
  28.  * Shouts go out to Mike "DJ XPCom" Ang.
  29.  *
  30.  * History
  31.  *  v1.23 - Jun 5 2002 - Michael Olson <olson@cs.odu.edu>
  32.  *   added a module option to allow selection of GPIO pin number 
  33.  *   for external amp 
  34.  *  v1.22 - Feb 28 2001 - Zach Brown <zab@zabbo.net>
  35.  *   allocate mem at insmod/setup, rather than open
  36.  *   limit pci dma addresses to 28bit, thanks guys.
  37.  *  v1.21 - Feb 04 2001 - Zach Brown <zab@zabbo.net>
  38.  *   fix up really dumb notifier -> suspend oops
  39.  *  v1.20 - Jan 30 2001 - Zach Brown <zab@zabbo.net>
  40.  *   get rid of pm callback and use pci_dev suspend/resume instead
  41.  *   m3_probe cleanups, including pm oops think-o
  42.  *  v1.10 - Jan 6 2001 - Zach Brown <zab@zabbo.net>
  43.  *   revert to lame remap_page_range mmap() just to make it work
  44.  *   record mmap fixed.
  45.  *   fix up incredibly broken open/release resource management
  46.  *   duh.  fix record format setting.
  47.  *   add SMP locking and cleanup formatting here and there
  48.  *  v1.00 - Dec 16 2000 - Zach Brown <zab@zabbo.net>
  49.  *   port to sexy 2.4 interfaces
  50.  *   properly align instance allocations so recording works
  51.  *   clean up function namespace a little :/
  52.  *   update PCI IDs based on mail from ESS
  53.  *   arbitrarily bump version number to show its 2.4 now, 
  54.  *      2.2 will stay 0., oss_audio port gets 2.
  55.  *  v0.03 - Nov 05 2000 - Zach Brown <zab@zabbo.net>
  56.  *   disable recording but allow dsp to be opened read 
  57.  *   pull out most silly compat defines
  58.  *  v0.02 - Nov 04 2000 - Zach Brown <zab@zabbo.net>
  59.  *   changed clocking setup for m3, slowdown fixed.
  60.  *   codec reset is hopefully reliable now
  61.  *   rudimentary apm/power management makes suspend/resume work
  62.  *  v0.01 - Oct 31 2000 - Zach Brown <zab@zabbo.net>
  63.  *   first release
  64.  *  v0.00 - Sep 09 2000 - Zach Brown <zab@zabbo.net>
  65.  *   first pass derivation from maestro.c
  66.  *
  67.  * TODO
  68.  *  in/out allocated contiguously so fullduplex mmap will work?
  69.  *  no beep on init (mute)
  70.  *  resetup msrc data memory if freq changes?
  71.  *
  72.  *  --
  73.  *
  74.  *  Allow me to ramble a bit about the m3 architecture.  The core of the
  75.  *  chip is the 'assp', the custom ESS dsp that runs the show.  It has
  76.  *  a small amount of code and data ram.  ESS drops binary dsp code images
  77.  *  on our heads, but we don't get to see specs on the dsp.  
  78.  *
  79.  *  The constant piece of code on the dsp is the 'kernel'.  It also has a 
  80.  *  chunk of the dsp memory that is statically set aside for its control
  81.  *  info.  This is the KDATA defines in maestro3.h.  Part of its core
  82.  *  data is a list of code addresses that point to the pieces of DSP code
  83.  *  that it should walk through in its loop.  These other pieces of code
  84.  *  do the real work.  The kernel presumably jumps into each of them in turn.
  85.  *  These code images tend to have their own data area, and one can have
  86.  *  multiple data areas representing different states for each of the 'client
  87.  *  instance' code portions.  There is generally a list in the kernel data
  88.  *  that points to the data instances for a given piece of code.
  89.  *
  90.  *  We've only been given the binary image for the 'minisrc', mini sample 
  91.  *  rate converter.  This is rather annoying because it limits the work
  92.  *  we can do on the dsp, but it also greatly simplifies the job of managing
  93.  *  dsp data memory for the code and data for our playing streams :).  We
  94.  *  statically allocate the minisrc code into a region we 'know' to be free
  95.  *  based on the map of the binary kernel image we're loading.  We also 
  96.  *  statically allocate the data areas for the maximum number of pcm streams
  97.  *  we can be dealing with.  This max is set by the length of the static list
  98.  *  in the kernel data that records the number of minisrc data regions we
  99.  *  can have.  Thats right, all software dsp mixing with static code list
  100.  *  limits.  Rock.
  101.  *
  102.  *  How sound goes in and out is still a relative mystery.  It appears
  103.  *  that the dsp has the ability to get input and output through various
  104.  *  'connections'.  To do IO from or to a connection, you put the address
  105.  *  of the minisrc client area in the static kernel data lists for that 
  106.  *  input or output.  so for pcm -> dsp -> mixer, we put the minisrc data
  107.  *  instance in the DMA list and also in the list for the mixer.  I guess
  108.  *  it Just Knows which is in/out, and we give some dma control info that
  109.  *  helps.  There are all sorts of cool inputs/outputs that it seems we can't
  110.  *  use without dsp code images that know how to use them.
  111.  *
  112.  *  So at init time we preload all the memory allocation stuff and set some
  113.  *  system wide parameters.  When we really get a sound to play we build
  114.  *  up its minisrc header (stream parameters, buffer addresses, input/output
  115.  *  settings).  Then we throw its header on the various lists.  We also
  116.  *  tickle some KDATA settings that ask the assp to raise clock interrupts
  117.  *  and do some amount of software mixing before handing data to the ac97.
  118.  *
  119.  *  Sorry for the vague details.  Feel free to ask Eric or myself if you
  120.  *  happen to be trying to use this driver elsewhere.  Please accept my
  121.  *  apologies for the quality of the OSS support code, its passed through
  122.  *  too many hands now and desperately wants to be rethought.
  123.  */
  124. /*****************************************************************************/
  125. #include <linux/config.h>
  126. #include <linux/module.h>
  127. #include <linux/kernel.h>
  128. #include <linux/string.h>
  129. #include <linux/ctype.h>
  130. #include <linux/ioport.h>
  131. #include <linux/sched.h>
  132. #include <linux/delay.h>
  133. #include <linux/sound.h>
  134. #include <linux/slab.h>
  135. #include <linux/soundcard.h>
  136. #include <linux/pci.h>
  137. #include <linux/vmalloc.h>
  138. #include <asm/io.h>
  139. #include <asm/dma.h>
  140. #include <linux/init.h>
  141. #include <linux/poll.h>
  142. #include <linux/reboot.h>
  143. #include <asm/uaccess.h>
  144. #include <asm/hardirq.h>
  145. #include <linux/spinlock.h>
  146. #include <linux/ac97_codec.h>
  147.  /*
  148.   * for crizappy mmap()
  149.   */
  150. #include <linux/wrapper.h>
  151. #include "maestro3.h"
  152. #define M_DEBUG 1
  153. #define DRIVER_VERSION      "1.23"
  154. #define M3_MODULE_NAME      "maestro3"
  155. #define PFX                 M3_MODULE_NAME ": "
  156. #define M3_STATE_MAGIC      0x734d724d
  157. #define M3_CARD_MAGIC       0x646e6f50
  158. #define ESS_FMT_STEREO      0x01
  159. #define ESS_FMT_16BIT       0x02
  160. #define ESS_FMT_MASK        0x03
  161. #define ESS_DAC_SHIFT       0   
  162. #define ESS_ADC_SHIFT       4
  163. #define DAC_RUNNING         1
  164. #define ADC_RUNNING         2
  165. #define SND_DEV_DSP16       5 
  166.    
  167. #ifdef M_DEBUG
  168. static int debug;
  169. #define DPMOD   1   /* per module load */
  170. #define DPSTR   2   /* per 'stream' */
  171. #define DPSYS   3   /* per syscall */
  172. #define DPCRAP  4   /* stuff the user shouldn't see unless they're really debuggin */
  173. #define DPINT   5   /* per interrupt, LOTS */
  174. #define DPRINTK(DP, args...) {if (debug >= (DP)) printk(KERN_DEBUG PFX args);}
  175. #else
  176. #define DPRINTK(x)
  177. #endif
  178. struct m3_list {
  179.     int curlen;
  180.     u16 mem_addr;
  181.     int max;
  182. };
  183. int external_amp = 1;
  184. int gpio_pin = -1;
  185. struct m3_state {
  186.     unsigned int magic;
  187.     struct m3_card *card;
  188.     unsigned char fmt, enable;
  189.     int index;
  190.     /* this locks around the oss state in the driver */
  191.     spinlock_t lock;
  192.     struct semaphore open_sem;
  193.     wait_queue_head_t open_wait;
  194.     mode_t open_mode;
  195.     int dev_audio;
  196.     struct assp_instance {
  197.         u16 code, data;
  198.     } dac_inst, adc_inst;
  199.     /* should be in dmabuf */
  200.     unsigned int rateadc, ratedac;
  201.     struct dmabuf {
  202.         void *rawbuf;
  203.         unsigned buforder;
  204.         unsigned numfrag;
  205.         unsigned fragshift;
  206.         unsigned hwptr, swptr;
  207.         unsigned total_bytes;
  208.         int count;
  209.         unsigned error; /* over/underrun */
  210.         wait_queue_head_t wait;
  211.         /* redundant, but makes calculations easier */
  212.         unsigned fragsize;
  213.         unsigned dmasize;
  214.         unsigned fragsamples;
  215.         /* OSS stuff */
  216.         unsigned mapped:1;
  217.         unsigned ready:1;    
  218.         unsigned endcleared:1;
  219.         unsigned ossfragshift;
  220.         int ossmaxfrags;
  221.         unsigned subdivision;
  222.         /* new in m3 */
  223.         int mixer_index, dma_index, msrc_index, adc1_index;
  224.         int in_lists;
  225.         /* 2.4.. */
  226.         dma_addr_t handle;
  227.     } dma_dac, dma_adc;
  228. };
  229.     
  230. struct m3_card {
  231.     unsigned int magic;
  232.     struct m3_card *next;
  233.     struct ac97_codec *ac97;
  234.     spinlock_t ac97_lock;
  235.     int card_type;
  236. #define NR_DSPS 1
  237. #define MAX_DSPS NR_DSPS
  238.     struct m3_state channels[MAX_DSPS];
  239.     /* this locks around the physical registers on the card */
  240.     spinlock_t lock;
  241.     /* hardware resources */
  242.     struct pci_dev *pcidev;
  243.     u32 iobase;
  244.     u32 irq;
  245.     int dacs_active;
  246.     int timer_users;
  247.     struct m3_list  msrc_list,
  248.                     mixer_list,
  249.                     adc1_list,
  250.                     dma_list;
  251.     /* for storing reset state..*/
  252.     u8 reset_state;
  253.     u16 *suspend_mem;
  254.     int in_suspend;
  255.     wait_queue_head_t suspend_queue;
  256. };
  257. /*
  258.  * an arbitrary volume we set the internal
  259.  * volume settings to so that the ac97 volume
  260.  * range is a little less insane.  0x7fff is 
  261.  * max.
  262.  */
  263. #define ARB_VOLUME ( 0x6800 )
  264. static const unsigned sample_shift[] = { 0, 1, 1, 2 };
  265. enum {
  266.     ESS_ALLEGRO,
  267.     ESS_MAESTRO3,
  268.     /*
  269.      * a maestro3 with 'hardware strapping', only
  270.      * found inside ESS?
  271.      */
  272.     ESS_MAESTRO3HW,
  273. };
  274. static char *card_names[] = {
  275.     [ESS_ALLEGRO] = "Allegro",
  276.     [ESS_MAESTRO3] = "Maestro3(i)",
  277.     [ESS_MAESTRO3HW] = "Maestro3(i)hw"
  278. };
  279. #ifndef PCI_VENDOR_ESS
  280. #define PCI_VENDOR_ESS      0x125D
  281. #endif
  282. #define M3_DEVICE(DEV, TYPE)                
  283. {                                           
  284. vendor: PCI_VENDOR_ESS,                     
  285. device: DEV,                                
  286. subvendor: PCI_ANY_ID,                      
  287. subdevice: PCI_ANY_ID,                      
  288. class:  PCI_CLASS_MULTIMEDIA_AUDIO << 8,    
  289. class_mask: 0xffff << 8,                    
  290. driver_data: TYPE,                          
  291. }
  292. static struct pci_device_id m3_id_table[] __initdata = {
  293.     M3_DEVICE(0x1988, ESS_ALLEGRO),
  294.     M3_DEVICE(0x1998, ESS_MAESTRO3),
  295.     M3_DEVICE(0x199a, ESS_MAESTRO3HW),
  296.     {0,}
  297. };
  298. MODULE_DEVICE_TABLE (pci, m3_id_table);
  299. /*
  300.  * reports seem to indicate that the m3 is limited
  301.  * to 28bit bus addresses.  aaaargggh...
  302.  */
  303. #define M3_PCI_DMA_MASK 0x0fffffff
  304. static unsigned 
  305. ld2(unsigned int x)
  306. {
  307.     unsigned r = 0;
  308.     
  309.     if (x >= 0x10000) {
  310.         x >>= 16;
  311.         r += 16;
  312.     }
  313.     if (x >= 0x100) {
  314.         x >>= 8;
  315.         r += 8;
  316.     }
  317.     if (x >= 0x10) {
  318.         x >>= 4;
  319.         r += 4;
  320.     }
  321.     if (x >= 4) {
  322.         x >>= 2;
  323.         r += 2;
  324.     }
  325.     if (x >= 2)
  326.         r++;
  327.     return r;
  328. }
  329. static struct m3_card *devs;
  330. /*
  331.  * I'm not very good at laying out functions in a file :)
  332.  */
  333. static int m3_notifier(struct notifier_block *nb, unsigned long event, void *buf);
  334. static int m3_suspend(struct pci_dev *pci_dev, u32 state);
  335. static void check_suspend(struct m3_card *card);
  336. struct notifier_block m3_reboot_nb = {m3_notifier, NULL, 0};
  337. static void m3_outw(struct m3_card *card,
  338.         u16 value, unsigned long reg)
  339. {
  340.     check_suspend(card);
  341.     outw(value, card->iobase + reg);
  342. }
  343. static u16 m3_inw(struct m3_card *card, unsigned long reg)
  344. {
  345.     check_suspend(card);
  346.     return inw(card->iobase + reg);
  347. }
  348. static void m3_outb(struct m3_card *card, 
  349.         u8 value, unsigned long reg)
  350. {
  351.     check_suspend(card);
  352.     outb(value, card->iobase + reg);
  353. }
  354. static u8 m3_inb(struct m3_card *card, unsigned long reg)
  355. {
  356.     check_suspend(card);
  357.     return inb(card->iobase + reg);
  358. }
  359. /*
  360.  * access 16bit words to the code or data regions of the dsp's memory.
  361.  * index addresses 16bit words.
  362.  */
  363. static u16 __m3_assp_read(struct m3_card *card, u16 region, u16 index)
  364. {
  365.     m3_outw(card, region & MEMTYPE_MASK, DSP_PORT_MEMORY_TYPE);
  366.     m3_outw(card, index, DSP_PORT_MEMORY_INDEX);
  367.     return m3_inw(card, DSP_PORT_MEMORY_DATA);
  368. }
  369. static u16 m3_assp_read(struct m3_card *card, u16 region, u16 index)
  370. {
  371.     unsigned long flags;
  372.     u16 ret;
  373.     spin_lock_irqsave(&(card->lock), flags);
  374.     ret = __m3_assp_read(card, region, index);
  375.     spin_unlock_irqrestore(&(card->lock), flags);
  376.     return ret;
  377. }
  378. static void __m3_assp_write(struct m3_card *card, 
  379.         u16 region, u16 index, u16 data)
  380. {
  381.     m3_outw(card, region & MEMTYPE_MASK, DSP_PORT_MEMORY_TYPE);
  382.     m3_outw(card, index, DSP_PORT_MEMORY_INDEX);
  383.     m3_outw(card, data, DSP_PORT_MEMORY_DATA);
  384. }
  385. static void m3_assp_write(struct m3_card *card, 
  386.         u16 region, u16 index, u16 data)
  387. {
  388.     unsigned long flags;
  389.     spin_lock_irqsave(&(card->lock), flags);
  390.     __m3_assp_write(card, region, index, data);
  391.     spin_unlock_irqrestore(&(card->lock), flags);
  392. }
  393. static void m3_assp_halt(struct m3_card *card)
  394. {
  395.     card->reset_state = m3_inb(card, DSP_PORT_CONTROL_REG_B) & ~REGB_STOP_CLOCK;
  396.     mdelay(10);
  397.     m3_outb(card, card->reset_state & ~REGB_ENABLE_RESET, DSP_PORT_CONTROL_REG_B);
  398. }
  399. static void m3_assp_continue(struct m3_card *card)
  400. {
  401.     m3_outb(card, card->reset_state | REGB_ENABLE_RESET, DSP_PORT_CONTROL_REG_B);
  402. }
  403. /*
  404.  * This makes me sad. the maestro3 has lists
  405.  * internally that must be packed.. 0 terminates,
  406.  * apparently, or maybe all unused entries have
  407.  * to be 0, the lists have static lengths set
  408.  * by the binary code images.
  409.  */
  410. static int m3_add_list(struct m3_card *card,
  411.         struct m3_list *list, u16 val)
  412. {
  413.     DPRINTK(DPSTR, "adding val 0x%x to list 0x%p at pos %dn",
  414.             val, list, list->curlen);
  415.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  416.             list->mem_addr + list->curlen,
  417.             val);
  418.     return list->curlen++;
  419. }
  420. static void m3_remove_list(struct m3_card *card,
  421.         struct m3_list *list, int index)
  422. {
  423.     u16  val;
  424.     int lastindex = list->curlen - 1;
  425.     DPRINTK(DPSTR, "removing ind %d from list 0x%pn",
  426.             index, list);
  427.     if(index != lastindex) {
  428.         val = m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  429.                 list->mem_addr + lastindex);
  430.         m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  431.                 list->mem_addr + index,
  432.                 val);
  433.     }
  434.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  435.             list->mem_addr + lastindex,
  436.             0);
  437.     list->curlen--;
  438. }
  439. static void set_fmt(struct m3_state *s, unsigned char mask, unsigned char data)
  440. {
  441.     int tmp;
  442.     s->fmt = (s->fmt & mask) | data;
  443.     tmp = (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK;
  444.     /* write to 'mono' word */
  445.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  446.             s->dac_inst.data + SRC3_DIRECTION_OFFSET + 1, 
  447.             (tmp & ESS_FMT_STEREO) ? 0 : 1);
  448.     /* write to '8bit' word */
  449.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  450.             s->dac_inst.data + SRC3_DIRECTION_OFFSET + 2, 
  451.             (tmp & ESS_FMT_16BIT) ? 0 : 1);
  452.     tmp = (s->fmt >> ESS_ADC_SHIFT) & ESS_FMT_MASK;
  453.     /* write to 'mono' word */
  454.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  455.             s->adc_inst.data + SRC3_DIRECTION_OFFSET + 1, 
  456.             (tmp & ESS_FMT_STEREO) ? 0 : 1);
  457.     /* write to '8bit' word */
  458.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  459.             s->adc_inst.data + SRC3_DIRECTION_OFFSET + 2, 
  460.             (tmp & ESS_FMT_16BIT) ? 0 : 1);
  461. }
  462. static void set_dac_rate(struct m3_state *s, unsigned int rate)
  463. {
  464.     u32 freq;
  465.     if (rate > 48000)
  466.         rate = 48000;
  467.     if (rate < 8000)
  468.         rate = 8000;
  469.     s->ratedac = rate;
  470.     freq = ((rate << 15) + 24000 ) / 48000;
  471.     if(freq) 
  472.         freq--;
  473.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  474.             s->dac_inst.data + CDATA_FREQUENCY,
  475.             freq);
  476. }
  477. static void set_adc_rate(struct m3_state *s, unsigned int rate)
  478. {
  479.     u32 freq;
  480.     if (rate > 48000)
  481.         rate = 48000;
  482.     if (rate < 8000)
  483.         rate = 8000;
  484.     s->rateadc = rate;
  485.     freq = ((rate << 15) + 24000 ) / 48000;
  486.     if(freq) 
  487.         freq--;
  488.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  489.             s->adc_inst.data + CDATA_FREQUENCY,
  490.             freq);
  491. }
  492. static void inc_timer_users(struct m3_card *card)
  493. {
  494.     unsigned long flags;
  495.     spin_lock_irqsave(&card->lock, flags);
  496.     
  497.     card->timer_users++;
  498.     DPRINTK(DPSYS, "inc timer users now %dn",
  499.             card->timer_users);
  500.     if(card->timer_users != 1) 
  501.         goto out;
  502.     __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  503.         KDATA_TIMER_COUNT_RELOAD,
  504.          240 ) ;
  505.     __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  506.         KDATA_TIMER_COUNT_CURRENT,
  507.          240 ) ;
  508.     m3_outw(card,  
  509.             m3_inw(card, HOST_INT_CTRL) | CLKRUN_GEN_ENABLE,
  510.             HOST_INT_CTRL);
  511. out:
  512.     spin_unlock_irqrestore(&card->lock, flags);
  513. }
  514. static void dec_timer_users(struct m3_card *card)
  515. {
  516.     unsigned long flags;
  517.     spin_lock_irqsave(&card->lock, flags);
  518.     card->timer_users--;
  519.     DPRINTK(DPSYS, "dec timer users now %dn",
  520.             card->timer_users);
  521.     if(card->timer_users > 0 ) 
  522.         goto out;
  523.     __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  524.         KDATA_TIMER_COUNT_RELOAD,
  525.          0 ) ;
  526.     __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  527.         KDATA_TIMER_COUNT_CURRENT,
  528.          0 ) ;
  529.     m3_outw(card,  m3_inw(card, HOST_INT_CTRL) & ~CLKRUN_GEN_ENABLE,
  530.             HOST_INT_CTRL);
  531. out:
  532.     spin_unlock_irqrestore(&card->lock, flags);
  533. }
  534. /*
  535.  * {start,stop}_{adc,dac} should be called
  536.  * while holding the 'state' lock and they
  537.  * will try to grab the 'card' lock..
  538.  */
  539. static void stop_adc(struct m3_state *s)
  540. {
  541.     if (! (s->enable & ADC_RUNNING)) 
  542.         return;
  543.     s->enable &= ~ADC_RUNNING;
  544.     dec_timer_users(s->card);
  545.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  546.             s->adc_inst.data + CDATA_INSTANCE_READY, 0);
  547.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  548.             KDATA_ADC1_REQUEST, 0);
  549. }    
  550. static void stop_dac(struct m3_state *s)
  551. {
  552.     if (! (s->enable & DAC_RUNNING)) 
  553.         return;
  554.     DPRINTK(DPSYS, "stop_dac()n");
  555.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  556.             s->dac_inst.data + CDATA_INSTANCE_READY, 0);
  557.     s->enable &= ~DAC_RUNNING;
  558.     s->card->dacs_active--;
  559.     dec_timer_users(s->card);
  560.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  561.             KDATA_MIXER_TASK_NUMBER, 
  562.             s->card->dacs_active ) ;
  563. }    
  564. static void start_dac(struct m3_state *s)
  565. {
  566.     if( (!s->dma_dac.mapped && s->dma_dac.count < 1) ||
  567.             !s->dma_dac.ready ||
  568.             (s->enable & DAC_RUNNING)) 
  569.         return;
  570.     DPRINTK(DPSYS, "start_dac()n");
  571.     s->enable |= DAC_RUNNING;
  572.     s->card->dacs_active++;
  573.     inc_timer_users(s->card);
  574.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  575.             s->dac_inst.data + CDATA_INSTANCE_READY, 1);
  576.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  577.             KDATA_MIXER_TASK_NUMBER, 
  578.             s->card->dacs_active ) ;
  579. }    
  580. static void start_adc(struct m3_state *s)
  581. {
  582.     if ((! s->dma_adc.mapped &&
  583.                 s->dma_adc.count >= (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize)) 
  584.         || !s->dma_adc.ready 
  585.         || (s->enable & ADC_RUNNING) ) 
  586.             return;
  587.     DPRINTK(DPSYS, "start_adc()n");
  588.     s->enable |= ADC_RUNNING;
  589.     inc_timer_users(s->card);
  590.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  591.             KDATA_ADC1_REQUEST, 1);
  592.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  593.             s->adc_inst.data + CDATA_INSTANCE_READY, 1);
  594. }    
  595. static struct play_vals {
  596.     u16 addr, val;
  597. } pv[] = {
  598.     {CDATA_LEFT_VOLUME, ARB_VOLUME},
  599.     {CDATA_RIGHT_VOLUME, ARB_VOLUME},
  600.     {SRC3_DIRECTION_OFFSET, 0} ,
  601.     /* +1, +2 are stereo/16 bit */
  602.     {SRC3_DIRECTION_OFFSET + 3, 0x0000}, /* fraction? */
  603.     {SRC3_DIRECTION_OFFSET + 4, 0}, /* first l */
  604.     {SRC3_DIRECTION_OFFSET + 5, 0}, /* first r */
  605.     {SRC3_DIRECTION_OFFSET + 6, 0}, /* second l */
  606.     {SRC3_DIRECTION_OFFSET + 7, 0}, /* second r */
  607.     {SRC3_DIRECTION_OFFSET + 8, 0}, /* delta l */
  608.     {SRC3_DIRECTION_OFFSET + 9, 0}, /* delta r */
  609.     {SRC3_DIRECTION_OFFSET + 10, 0x8000}, /* round */
  610.     {SRC3_DIRECTION_OFFSET + 11, 0xFF00}, /* higher bute mark */
  611.     {SRC3_DIRECTION_OFFSET + 13, 0}, /* temp0 */
  612.     {SRC3_DIRECTION_OFFSET + 14, 0}, /* c fraction */
  613.     {SRC3_DIRECTION_OFFSET + 15, 0}, /* counter */
  614.     {SRC3_DIRECTION_OFFSET + 16, 8}, /* numin */
  615.     {SRC3_DIRECTION_OFFSET + 17, 50*2}, /* numout */
  616.     {SRC3_DIRECTION_OFFSET + 18, MINISRC_BIQUAD_STAGE - 1}, /* numstage */
  617.     {SRC3_DIRECTION_OFFSET + 20, 0}, /* filtertap */
  618.     {SRC3_DIRECTION_OFFSET + 21, 0} /* booster */
  619. };
  620. /* the mode passed should be already shifted and masked */
  621. static void m3_play_setup(struct m3_state *s, int mode, u32 rate, void *buffer, int size)
  622. {
  623.     int dsp_in_size = MINISRC_IN_BUFFER_SIZE - (0x20 * 2);
  624.     int dsp_out_size = MINISRC_OUT_BUFFER_SIZE - (0x20 * 2);
  625.     int dsp_in_buffer = s->dac_inst.data + (MINISRC_TMP_BUFFER_SIZE / 2);
  626.     int dsp_out_buffer = dsp_in_buffer + (dsp_in_size / 2) + 1;
  627.     struct dmabuf *db = &s->dma_dac;
  628.     int i;
  629.     DPRINTK(DPSTR, "mode=%d rate=%d buf=%p len=%d.n",
  630.         mode, rate, buffer, size);
  631. #define LO(x) ((x) & 0xffff)
  632. #define HI(x) LO((x) >> 16)
  633.     /* host dma buffer pointers */
  634.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  635.         s->dac_inst.data + CDATA_HOST_SRC_ADDRL,
  636.         LO(virt_to_bus(buffer)));
  637.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  638.         s->dac_inst.data + CDATA_HOST_SRC_ADDRH,
  639.         HI(virt_to_bus(buffer)));
  640.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  641.         s->dac_inst.data + CDATA_HOST_SRC_END_PLUS_1L,
  642.         LO(virt_to_bus(buffer) + size));
  643.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  644.         s->dac_inst.data + CDATA_HOST_SRC_END_PLUS_1H,
  645.         HI(virt_to_bus(buffer) + size));
  646.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  647.         s->dac_inst.data + CDATA_HOST_SRC_CURRENTL,
  648.         LO(virt_to_bus(buffer)));
  649.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  650.         s->dac_inst.data + CDATA_HOST_SRC_CURRENTH,
  651.         HI(virt_to_bus(buffer)));
  652. #undef LO
  653. #undef HI
  654.     /* dsp buffers */
  655.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  656.         s->dac_inst.data + CDATA_IN_BUF_BEGIN,
  657.         dsp_in_buffer);
  658.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  659.         s->dac_inst.data + CDATA_IN_BUF_END_PLUS_1,
  660.         dsp_in_buffer + (dsp_in_size / 2));
  661.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  662.         s->dac_inst.data + CDATA_IN_BUF_HEAD,
  663.         dsp_in_buffer);
  664.     
  665.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  666.         s->dac_inst.data + CDATA_IN_BUF_TAIL,
  667.         dsp_in_buffer);
  668.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  669.         s->dac_inst.data + CDATA_OUT_BUF_BEGIN,
  670.         dsp_out_buffer);
  671.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  672.         s->dac_inst.data + CDATA_OUT_BUF_END_PLUS_1,
  673.         dsp_out_buffer + (dsp_out_size / 2));
  674.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  675.         s->dac_inst.data + CDATA_OUT_BUF_HEAD,
  676.         dsp_out_buffer);
  677.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  678.         s->dac_inst.data + CDATA_OUT_BUF_TAIL,
  679.         dsp_out_buffer);
  680.     /*
  681.      * some per client initializers
  682.      */
  683.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  684.         s->dac_inst.data + SRC3_DIRECTION_OFFSET + 12,
  685.         s->dac_inst.data + 40 + 8);
  686.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  687.         s->dac_inst.data + SRC3_DIRECTION_OFFSET + 19,
  688.         s->dac_inst.code + MINISRC_COEF_LOC);
  689.     /* enable or disable low pass filter? */
  690.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  691.         s->dac_inst.data + SRC3_DIRECTION_OFFSET + 22,
  692.         s->ratedac > 45000 ? 0xff : 0 );
  693.     
  694.     /* tell it which way dma is going? */
  695.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  696.         s->dac_inst.data + CDATA_DMA_CONTROL,
  697.         DMACONTROL_AUTOREPEAT + DMAC_PAGE3_SELECTOR + DMAC_BLOCKF_SELECTOR);
  698.     /*
  699.      * set an armload of static initializers
  700.      */
  701.     for(i = 0 ; i < (sizeof(pv) / sizeof(pv[0])) ; i++) 
  702.         m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  703.             s->dac_inst.data + pv[i].addr, pv[i].val);
  704.     /* 
  705.      * put us in the lists if we're not already there
  706.      */
  707.     if(db->in_lists == 0) {
  708.         db->msrc_index = m3_add_list(s->card, &s->card->msrc_list, 
  709.                 s->dac_inst.data >> DP_SHIFT_COUNT);
  710.         db->dma_index = m3_add_list(s->card, &s->card->dma_list, 
  711.                 s->dac_inst.data >> DP_SHIFT_COUNT);
  712.         db->mixer_index = m3_add_list(s->card, &s->card->mixer_list, 
  713.                 s->dac_inst.data >> DP_SHIFT_COUNT);
  714.         db->in_lists = 1;
  715.     }
  716.     set_dac_rate(s,rate);
  717.     start_dac(s);
  718. }
  719. /*
  720.  *    Native record driver 
  721.  */
  722. static struct rec_vals {
  723.     u16 addr, val;
  724. } rv[] = {
  725.     {CDATA_LEFT_VOLUME, ARB_VOLUME},
  726.     {CDATA_RIGHT_VOLUME, ARB_VOLUME},
  727.     {SRC3_DIRECTION_OFFSET, 1} ,
  728.     /* +1, +2 are stereo/16 bit */
  729.     {SRC3_DIRECTION_OFFSET + 3, 0x0000}, /* fraction? */
  730.     {SRC3_DIRECTION_OFFSET + 4, 0}, /* first l */
  731.     {SRC3_DIRECTION_OFFSET + 5, 0}, /* first r */
  732.     {SRC3_DIRECTION_OFFSET + 6, 0}, /* second l */
  733.     {SRC3_DIRECTION_OFFSET + 7, 0}, /* second r */
  734.     {SRC3_DIRECTION_OFFSET + 8, 0}, /* delta l */
  735.     {SRC3_DIRECTION_OFFSET + 9, 0}, /* delta r */
  736.     {SRC3_DIRECTION_OFFSET + 10, 0x8000}, /* round */
  737.     {SRC3_DIRECTION_OFFSET + 11, 0xFF00}, /* higher bute mark */
  738.     {SRC3_DIRECTION_OFFSET + 13, 0}, /* temp0 */
  739.     {SRC3_DIRECTION_OFFSET + 14, 0}, /* c fraction */
  740.     {SRC3_DIRECTION_OFFSET + 15, 0}, /* counter */
  741.     {SRC3_DIRECTION_OFFSET + 16, 50},/* numin */
  742.     {SRC3_DIRECTION_OFFSET + 17, 8}, /* numout */
  743.     {SRC3_DIRECTION_OFFSET + 18, 0}, /* numstage */
  744.     {SRC3_DIRECTION_OFFSET + 19, 0}, /* coef */
  745.     {SRC3_DIRECTION_OFFSET + 20, 0}, /* filtertap */
  746.     {SRC3_DIRECTION_OFFSET + 21, 0}, /* booster */
  747.     {SRC3_DIRECTION_OFFSET + 22, 0xff} /* skip lpf */
  748. };
  749. /* again, passed mode is alrady shifted/masked */
  750. static void m3_rec_setup(struct m3_state *s, int mode, u32 rate, void *buffer, int size)
  751. {
  752.     int dsp_in_size = MINISRC_IN_BUFFER_SIZE + (0x10 * 2);
  753.     int dsp_out_size = MINISRC_OUT_BUFFER_SIZE - (0x10 * 2);
  754.     int dsp_in_buffer = s->adc_inst.data + (MINISRC_TMP_BUFFER_SIZE / 2);
  755.     int dsp_out_buffer = dsp_in_buffer + (dsp_in_size / 2) + 1;
  756.     struct dmabuf *db = &s->dma_adc;
  757.     int i;
  758.     DPRINTK(DPSTR, "rec_setup mode=%d rate=%d buf=%p len=%d.n",
  759.         mode, rate, buffer, size);
  760. #define LO(x) ((x) & 0xffff)
  761. #define HI(x) LO((x) >> 16)
  762.     /* host dma buffer pointers */
  763.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  764.         s->adc_inst.data + CDATA_HOST_SRC_ADDRL,
  765.         LO(virt_to_bus(buffer)));
  766.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  767.         s->adc_inst.data + CDATA_HOST_SRC_ADDRH,
  768.         HI(virt_to_bus(buffer)));
  769.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  770.         s->adc_inst.data + CDATA_HOST_SRC_END_PLUS_1L,
  771.         LO(virt_to_bus(buffer) + size));
  772.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  773.         s->adc_inst.data + CDATA_HOST_SRC_END_PLUS_1H,
  774.         HI(virt_to_bus(buffer) + size));
  775.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  776.         s->adc_inst.data + CDATA_HOST_SRC_CURRENTL,
  777.         LO(virt_to_bus(buffer)));
  778.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  779.         s->adc_inst.data + CDATA_HOST_SRC_CURRENTH,
  780.         HI(virt_to_bus(buffer)));
  781. #undef LO
  782. #undef HI
  783.     /* dsp buffers */
  784.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  785.         s->adc_inst.data + CDATA_IN_BUF_BEGIN,
  786.         dsp_in_buffer);
  787.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  788.         s->adc_inst.data + CDATA_IN_BUF_END_PLUS_1,
  789.         dsp_in_buffer + (dsp_in_size / 2));
  790.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  791.         s->adc_inst.data + CDATA_IN_BUF_HEAD,
  792.         dsp_in_buffer);
  793.     
  794.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  795.         s->adc_inst.data + CDATA_IN_BUF_TAIL,
  796.         dsp_in_buffer);
  797.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  798.         s->adc_inst.data + CDATA_OUT_BUF_BEGIN,
  799.         dsp_out_buffer);
  800.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  801.         s->adc_inst.data + CDATA_OUT_BUF_END_PLUS_1,
  802.         dsp_out_buffer + (dsp_out_size / 2));
  803.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  804.         s->adc_inst.data + CDATA_OUT_BUF_HEAD,
  805.         dsp_out_buffer);
  806.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  807.         s->adc_inst.data + CDATA_OUT_BUF_TAIL,
  808.         dsp_out_buffer);
  809.     /*
  810.      * some per client initializers
  811.      */
  812.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  813.         s->adc_inst.data + SRC3_DIRECTION_OFFSET + 12,
  814.         s->adc_inst.data + 40 + 8);
  815.     /* tell it which way dma is going? */
  816.     m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  817.         s->adc_inst.data + CDATA_DMA_CONTROL,
  818.         DMACONTROL_DIRECTION + DMACONTROL_AUTOREPEAT + 
  819.         DMAC_PAGE3_SELECTOR + DMAC_BLOCKF_SELECTOR);
  820.     /*
  821.      * set an armload of static initializers
  822.      */
  823.     for(i = 0 ; i < (sizeof(rv) / sizeof(rv[0])) ; i++) 
  824.         m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  825.             s->adc_inst.data + rv[i].addr, rv[i].val);
  826.     /* 
  827.      * put us in the lists if we're not already there
  828.      */
  829.     if(db->in_lists == 0) {
  830.         db->adc1_index = m3_add_list(s->card, &s->card->adc1_list, 
  831.                 s->adc_inst.data >> DP_SHIFT_COUNT);
  832.         db->dma_index = m3_add_list(s->card, &s->card->dma_list, 
  833.                 s->adc_inst.data >> DP_SHIFT_COUNT);
  834.         db->msrc_index = m3_add_list(s->card, &s->card->msrc_list, 
  835.                 s->adc_inst.data >> DP_SHIFT_COUNT);
  836.         db->in_lists = 1;
  837.     }
  838.     set_adc_rate(s,rate);
  839.     start_adc(s);
  840. }
  841. /* --------------------------------------------------------------------- */
  842. static void set_dmaa(struct m3_state *s, unsigned int addr, unsigned int count)
  843. {
  844.     DPRINTK(DPINT,"set_dmaa??n");
  845. }
  846. static void set_dmac(struct m3_state *s, unsigned int addr, unsigned int count)
  847. {
  848.     DPRINTK(DPINT,"set_dmac??n");
  849. }
  850. u32 get_dma_pos(struct m3_card *card,
  851.         int instance_addr)
  852. {
  853.     u16 hi = 0, lo = 0;
  854.     int retry = 10;
  855.     /*
  856.      * try and get a valid answer
  857.      */
  858.     while(retry--) {
  859.         hi =  m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  860.                 instance_addr + CDATA_HOST_SRC_CURRENTH);
  861.         lo = m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  862.                 instance_addr + CDATA_HOST_SRC_CURRENTL);
  863.         if(hi == m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  864.                 instance_addr + CDATA_HOST_SRC_CURRENTH))
  865.             break;
  866.     }
  867.     return lo | (hi<<16);
  868. }
  869. u32 get_dmaa(struct m3_state *s)
  870. {
  871.     u32 offset;
  872.     offset = get_dma_pos(s->card, s->dac_inst.data) - 
  873.         virt_to_bus(s->dma_dac.rawbuf);
  874.     DPRINTK(DPINT,"get_dmaa: 0x%08xn",offset);
  875.     return offset;
  876. }
  877. u32 get_dmac(struct m3_state *s)
  878. {
  879.     u32 offset;
  880.     offset = get_dma_pos(s->card, s->adc_inst.data) -
  881.         virt_to_bus(s->dma_adc.rawbuf);
  882.     DPRINTK(DPINT,"get_dmac: 0x%08xn",offset);
  883.     return offset;
  884. }
  885. static void m3_interrupt(int irq, void *dev_id, struct pt_regs *regs);
  886. static int 
  887. prog_dmabuf(struct m3_state *s, unsigned rec)
  888. {
  889.     struct dmabuf *db = rec ? &s->dma_adc : &s->dma_dac;
  890.     unsigned rate = rec ? s->rateadc : s->ratedac;
  891.     unsigned bytepersec;
  892.     unsigned bufs;
  893.     unsigned char fmt;
  894.     unsigned long flags;
  895.     spin_lock_irqsave(&s->lock, flags);
  896.     fmt = s->fmt;
  897.     if (rec) {
  898.         stop_adc(s);
  899.         fmt >>= ESS_ADC_SHIFT;
  900.     } else {
  901.         stop_dac(s);
  902.         fmt >>= ESS_DAC_SHIFT;
  903.     }
  904.     fmt &= ESS_FMT_MASK;
  905.     db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0;
  906.     bytepersec = rate << sample_shift[fmt];
  907.     bufs = PAGE_SIZE << db->buforder;
  908.     if (db->ossfragshift) {
  909.         if ((1000 << db->ossfragshift) < bytepersec)
  910.             db->fragshift = ld2(bytepersec/1000);
  911.         else
  912.             db->fragshift = db->ossfragshift;
  913.     } else {
  914.         db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
  915.         if (db->fragshift < 3)
  916.             db->fragshift = 3; 
  917.     }
  918.     db->numfrag = bufs >> db->fragshift;
  919.     while (db->numfrag < 4 && db->fragshift > 3) {
  920.         db->fragshift--;
  921.         db->numfrag = bufs >> db->fragshift;
  922.     }
  923.     db->fragsize = 1 << db->fragshift;
  924.     if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
  925.         db->numfrag = db->ossmaxfrags;
  926.     db->fragsamples = db->fragsize >> sample_shift[fmt];
  927.     db->dmasize = db->numfrag << db->fragshift;
  928.     DPRINTK(DPSTR,"prog_dmabuf: numfrag: %d fragsize: %d dmasize: %dn",db->numfrag,db->fragsize,db->dmasize);
  929.     memset(db->rawbuf, (fmt & ESS_FMT_16BIT) ? 0 : 0x80, db->dmasize);
  930.     if (rec) 
  931.         m3_rec_setup(s, fmt, s->rateadc, db->rawbuf, db->dmasize);
  932.     else 
  933.         m3_play_setup(s, fmt, s->ratedac, db->rawbuf, db->dmasize);
  934.     db->ready = 1;
  935.     spin_unlock_irqrestore(&s->lock, flags);
  936.     return 0;
  937. }
  938. static void clear_advance(struct m3_state *s)
  939. {
  940.     unsigned char c = ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_16BIT) ? 0 : 0x80;
  941.     
  942.     unsigned char *buf = s->dma_dac.rawbuf;
  943.     unsigned bsize = s->dma_dac.dmasize;
  944.     unsigned bptr = s->dma_dac.swptr;
  945.     unsigned len = s->dma_dac.fragsize;
  946.     
  947.     if (bptr + len > bsize) {
  948.         unsigned x = bsize - bptr;
  949.         memset(buf + bptr, c, x);
  950.         /* account for wrapping? */
  951.         bptr = 0;
  952.         len -= x;
  953.     }
  954.     memset(buf + bptr, c, len);
  955. }
  956. /* call with spinlock held! */
  957. static void m3_update_ptr(struct m3_state *s)
  958. {
  959.     unsigned hwptr;
  960.     int diff;
  961.     /* update ADC pointer */
  962.     if (s->dma_adc.ready) {
  963.         hwptr = get_dmac(s) % s->dma_adc.dmasize;
  964.         diff = (s->dma_adc.dmasize + hwptr - s->dma_adc.hwptr) % s->dma_adc.dmasize;
  965.         s->dma_adc.hwptr = hwptr;
  966.         s->dma_adc.total_bytes += diff;
  967.         s->dma_adc.count += diff;
  968.         if (s->dma_adc.count >= (signed)s->dma_adc.fragsize) 
  969.             wake_up(&s->dma_adc.wait);
  970.         if (!s->dma_adc.mapped) {
  971.             if (s->dma_adc.count > (signed)(s->dma_adc.dmasize - ((3 * s->dma_adc.fragsize) >> 1))) {
  972.                 stop_adc(s); 
  973.                 /* brute force everyone back in sync, sigh */
  974.                 s->dma_adc.count = 0;
  975.                 s->dma_adc.swptr = 0;
  976.                 s->dma_adc.hwptr = 0;
  977.                 s->dma_adc.error++;
  978.             }
  979.         }
  980.     }
  981.     /* update DAC pointer */
  982.     if (s->dma_dac.ready) {
  983.         hwptr = get_dmaa(s) % s->dma_dac.dmasize; 
  984.         diff = (s->dma_dac.dmasize + hwptr - s->dma_dac.hwptr) % s->dma_dac.dmasize;
  985.         DPRINTK(DPINT,"updating dac: hwptr: %6d diff: %6d count: %6dn",
  986.                 hwptr,diff,s->dma_dac.count);
  987.         s->dma_dac.hwptr = hwptr;
  988.         s->dma_dac.total_bytes += diff;
  989.         if (s->dma_dac.mapped) {
  990.             
  991.             s->dma_dac.count += diff;
  992.             if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) {
  993.                 wake_up(&s->dma_dac.wait);
  994.             }
  995.         } else {
  996.             s->dma_dac.count -= diff;
  997.             
  998.             if (s->dma_dac.count <= 0) {
  999.                 DPRINTK(DPCRAP,"underflow! diff: %d (0x%x) count: %d (0x%x) hw: %d (0x%x) sw: %d (0x%x)n", 
  1000.                         diff, diff, 
  1001.                         s->dma_dac.count, 
  1002.                         s->dma_dac.count, 
  1003.                     hwptr, hwptr,
  1004.                     s->dma_dac.swptr,
  1005.                     s->dma_dac.swptr);
  1006.                 stop_dac(s);
  1007.                 /* brute force everyone back in sync, sigh */
  1008.                 s->dma_dac.count = 0; 
  1009.                 s->dma_dac.swptr = hwptr; 
  1010.                 s->dma_dac.error++;
  1011.             } else if (s->dma_dac.count <= (signed)s->dma_dac.fragsize && !s->dma_dac.endcleared) {
  1012.                 clear_advance(s);
  1013.                 s->dma_dac.endcleared = 1;
  1014.             }
  1015.             if (s->dma_dac.count + (signed)s->dma_dac.fragsize <= (signed)s->dma_dac.dmasize) {
  1016.                 wake_up(&s->dma_dac.wait);
  1017.                 DPRINTK(DPINT,"waking up DAC count: %d sw: %d hw: %dn",
  1018.                         s->dma_dac.count, s->dma_dac.swptr, hwptr);
  1019.             }
  1020.         }
  1021.     }
  1022. }
  1023. static void m3_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  1024. {
  1025.     struct m3_card *c = (struct m3_card *)dev_id;
  1026.     struct m3_state *s = &c->channels[0];
  1027.     u8 status;
  1028.     status = inb(c->iobase+0x1A);
  1029.     if(status == 0xff) return;
  1030.    
  1031.     /* presumably acking the ints? */
  1032.     outw(status, c->iobase+0x1A); 
  1033.     if(c->in_suspend)
  1034.         return;
  1035.     /*
  1036.      * ack an assp int if its running
  1037.      * and has an int pending
  1038.      */
  1039.     if( status & ASSP_INT_PENDING) {
  1040.         u8 ctl = inb(c->iobase + ASSP_CONTROL_B);
  1041.         if( !(ctl & STOP_ASSP_CLOCK)) {
  1042.             ctl = inb(c->iobase + ASSP_HOST_INT_STATUS );
  1043.             if(ctl & DSP2HOST_REQ_TIMER) {
  1044.                 outb( DSP2HOST_REQ_TIMER, c->iobase + ASSP_HOST_INT_STATUS);
  1045.                 /* update adc/dac info if it was a timer int */
  1046.                 spin_lock(&s->lock);
  1047.                 m3_update_ptr(s);
  1048.                 spin_unlock(&s->lock);
  1049.             }
  1050.         }
  1051.     }
  1052.     /* XXX is this needed? */
  1053.     if(status & 0x40) 
  1054.         outb(0x40, c->iobase+0x1A);
  1055. }
  1056. /* --------------------------------------------------------------------- */
  1057. static const char invalid_magic[] = KERN_CRIT PFX "invalid magic value in %sn";
  1058. #define VALIDATE_MAGIC(FOO,MAG)                         
  1059. ({                                                
  1060.     if (!(FOO) || (FOO)->magic != MAG) { 
  1061.         printk(invalid_magic,__FUNCTION__);            
  1062.         return -ENXIO;                    
  1063.     }                                         
  1064. })
  1065. #define VALIDATE_STATE(a) VALIDATE_MAGIC(a,M3_STATE_MAGIC)
  1066. #define VALIDATE_CARD(a) VALIDATE_MAGIC(a,M3_CARD_MAGIC)
  1067. /* --------------------------------------------------------------------- */
  1068. static int drain_dac(struct m3_state *s, int nonblock)
  1069. {
  1070.     DECLARE_WAITQUEUE(wait,current);
  1071.     unsigned long flags;
  1072.     int count;
  1073.     signed long tmo;
  1074.     if (s->dma_dac.mapped || !s->dma_dac.ready)
  1075.         return 0;
  1076.     set_current_state(TASK_INTERRUPTIBLE);
  1077.     add_wait_queue(&s->dma_dac.wait, &wait);
  1078.     for (;;) {
  1079.         spin_lock_irqsave(&s->lock, flags);
  1080.         count = s->dma_dac.count;
  1081.         spin_unlock_irqrestore(&s->lock, flags);
  1082.         if (count <= 0)
  1083.             break;
  1084.         if (signal_pending(current))
  1085.             break;
  1086.         if (nonblock) {
  1087.             remove_wait_queue(&s->dma_dac.wait, &wait);
  1088.             set_current_state(TASK_RUNNING);
  1089.             return -EBUSY;
  1090.         }
  1091.         tmo = (count * HZ) / s->ratedac;
  1092.         tmo >>= sample_shift[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK];
  1093.         /* XXX this is just broken.  someone is waking us up alot, or schedule_timeout is broken.
  1094.             or something.  who cares. - zach */
  1095.         if (!schedule_timeout(tmo ? tmo : 1) && tmo)
  1096.             DPRINTK(DPCRAP,"dma timed out?? %ldn",jiffies);
  1097.     }
  1098.     remove_wait_queue(&s->dma_dac.wait, &wait);
  1099.     set_current_state(TASK_RUNNING);
  1100.     if (signal_pending(current))
  1101.             return -ERESTARTSYS;
  1102.     return 0;
  1103. }
  1104. static ssize_t m3_read(struct file *file, char *buffer, size_t count, loff_t *ppos)
  1105. {
  1106.     struct m3_state *s = (struct m3_state *)file->private_data;
  1107.     ssize_t ret;
  1108.     unsigned long flags;
  1109.     unsigned swptr;
  1110.     int cnt;
  1111.     
  1112.     VALIDATE_STATE(s);
  1113.     if (ppos != &file->f_pos)
  1114.         return -ESPIPE;
  1115.     if (s->dma_adc.mapped)
  1116.         return -ENXIO;
  1117.     if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
  1118.         return ret;
  1119.     if (!access_ok(VERIFY_WRITE, buffer, count))
  1120.         return -EFAULT;
  1121.     ret = 0;
  1122.     spin_lock_irqsave(&s->lock, flags);
  1123.     while (count > 0) {
  1124.         int timed_out;
  1125.         swptr = s->dma_adc.swptr;
  1126.         cnt = s->dma_adc.dmasize-swptr;
  1127.         if (s->dma_adc.count < cnt)
  1128.             cnt = s->dma_adc.count;
  1129.         if (cnt > count)
  1130.             cnt = count;
  1131.         if (cnt <= 0) {
  1132.             start_adc(s);
  1133.             if (file->f_flags & O_NONBLOCK) 
  1134.             {
  1135.                 ret = ret ? ret : -EAGAIN;
  1136.                 goto out;
  1137.             }
  1138.             spin_unlock_irqrestore(&s->lock, flags);
  1139.             timed_out = interruptible_sleep_on_timeout(&s->dma_adc.wait, HZ) == 0;
  1140.             spin_lock_irqsave(&s->lock, flags);
  1141.             if(timed_out) {
  1142.                 printk("read: chip lockup? dmasz %u fragsz %u count %u hwptr %u swptr %un",
  1143.                        s->dma_adc.dmasize, s->dma_adc.fragsize, s->dma_adc.count, 
  1144.                        s->dma_adc.hwptr, s->dma_adc.swptr);
  1145.                 stop_adc(s);
  1146.                 set_dmac(s, virt_to_bus(s->dma_adc.rawbuf), s->dma_adc.numfrag << s->dma_adc.fragshift);
  1147.                 s->dma_adc.count = s->dma_adc.hwptr = s->dma_adc.swptr = 0;
  1148.             }
  1149.             if (signal_pending(current)) 
  1150.             {
  1151.                 ret = ret ? ret : -ERESTARTSYS;
  1152.                 goto out;
  1153.             }
  1154.             continue;
  1155.         }
  1156.     
  1157.         spin_unlock_irqrestore(&s->lock, flags);
  1158.         if (copy_to_user(buffer, s->dma_adc.rawbuf + swptr, cnt)) {
  1159.             ret = ret ? ret : -EFAULT;
  1160.             return ret;
  1161.         }
  1162.         spin_lock_irqsave(&s->lock, flags);
  1163.         swptr = (swptr + cnt) % s->dma_adc.dmasize;
  1164.         s->dma_adc.swptr = swptr;
  1165.         s->dma_adc.count -= cnt;
  1166.         count -= cnt;
  1167.         buffer += cnt;
  1168.         ret += cnt;
  1169.         start_adc(s);
  1170.     }
  1171. out:
  1172.     spin_unlock_irqrestore(&s->lock, flags);
  1173.     return ret;
  1174. }
  1175. static ssize_t m3_write(struct file *file, const char *buffer, size_t count, loff_t *ppos)
  1176. {
  1177.     struct m3_state *s = (struct m3_state *)file->private_data;
  1178.     ssize_t ret;
  1179.     unsigned long flags;
  1180.     unsigned swptr;
  1181.     int cnt;
  1182.     
  1183.     VALIDATE_STATE(s);
  1184.     if (ppos != &file->f_pos)
  1185.         return -ESPIPE;
  1186.     if (s->dma_dac.mapped)
  1187.         return -ENXIO;
  1188.     if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
  1189.         return ret;
  1190.     if (!access_ok(VERIFY_READ, buffer, count))
  1191.         return -EFAULT;
  1192.     ret = 0;
  1193.     spin_lock_irqsave(&s->lock, flags);
  1194.     while (count > 0) {
  1195.         int timed_out;
  1196.         if (s->dma_dac.count < 0) {
  1197.             s->dma_dac.count = 0;
  1198.             s->dma_dac.swptr = s->dma_dac.hwptr;
  1199.         }
  1200.         swptr = s->dma_dac.swptr;
  1201.         cnt = s->dma_dac.dmasize-swptr;
  1202.         if (s->dma_dac.count + cnt > s->dma_dac.dmasize)
  1203.             cnt = s->dma_dac.dmasize - s->dma_dac.count;
  1204.         if (cnt > count)
  1205.             cnt = count;
  1206.         if (cnt <= 0) {
  1207.             start_dac(s);
  1208.             if (file->f_flags & O_NONBLOCK) {
  1209.                 if(!ret) ret = -EAGAIN;
  1210.                 goto out;
  1211.             }
  1212.             spin_unlock_irqrestore(&s->lock, flags);
  1213.             timed_out = interruptible_sleep_on_timeout(&s->dma_dac.wait, HZ) == 0;
  1214.             spin_lock_irqsave(&s->lock, flags);
  1215.             if(timed_out) {
  1216.                 DPRINTK(DPCRAP,"write: chip lockup? dmasz %u fragsz %u count %u hwptr %u swptr %un",
  1217.                        s->dma_dac.dmasize, s->dma_dac.fragsize, s->dma_dac.count, 
  1218.                        s->dma_dac.hwptr, s->dma_dac.swptr);
  1219.                 stop_dac(s);
  1220.                 set_dmaa(s, virt_to_bus(s->dma_dac.rawbuf), s->dma_dac.numfrag << s->dma_dac.fragshift);
  1221.                 s->dma_dac.count = s->dma_dac.hwptr = s->dma_dac.swptr = 0;
  1222.             }
  1223.             if (signal_pending(current)) {
  1224.                 if (!ret) ret = -ERESTARTSYS;
  1225.                 goto out;
  1226.             }
  1227.             continue;
  1228.         }
  1229.         spin_unlock_irqrestore(&s->lock, flags);
  1230.         if (copy_from_user(s->dma_dac.rawbuf + swptr, buffer, cnt)) {
  1231.             if (!ret) ret = -EFAULT;
  1232.             return ret;
  1233.         }
  1234.         spin_lock_irqsave(&s->lock, flags);
  1235.         DPRINTK(DPSYS,"wrote %6d bytes at sw: %6d cnt: %6d while hw: %6dn",
  1236.                 cnt, swptr, s->dma_dac.count, s->dma_dac.hwptr);
  1237.         
  1238.         swptr = (swptr + cnt) % s->dma_dac.dmasize;
  1239.         s->dma_dac.swptr = swptr;
  1240.         s->dma_dac.count += cnt;
  1241.         s->dma_dac.endcleared = 0;
  1242.         count -= cnt;
  1243.         buffer += cnt;
  1244.         ret += cnt;
  1245.         start_dac(s);
  1246.     }
  1247. out:
  1248.     spin_unlock_irqrestore(&s->lock, flags);
  1249.     return ret;
  1250. }
  1251. static unsigned int m3_poll(struct file *file, struct poll_table_struct *wait)
  1252. {
  1253.     struct m3_state *s = (struct m3_state *)file->private_data;
  1254.     unsigned long flags;
  1255.     unsigned int mask = 0;
  1256.     VALIDATE_STATE(s);
  1257.     if (file->f_mode & FMODE_WRITE)
  1258.         poll_wait(file, &s->dma_dac.wait, wait);
  1259.     if (file->f_mode & FMODE_READ)
  1260.         poll_wait(file, &s->dma_adc.wait, wait);
  1261.     spin_lock_irqsave(&s->lock, flags);
  1262.     m3_update_ptr(s);
  1263.     if (file->f_mode & FMODE_READ) {
  1264.         if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
  1265.             mask |= POLLIN | POLLRDNORM;
  1266.     }
  1267.     if (file->f_mode & FMODE_WRITE) {
  1268.         if (s->dma_dac.mapped) {
  1269.             if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) 
  1270.                 mask |= POLLOUT | POLLWRNORM;
  1271.         } else {
  1272.             if ((signed)s->dma_dac.dmasize >= s->dma_dac.count + (signed)s->dma_dac.fragsize)
  1273.                 mask |= POLLOUT | POLLWRNORM;
  1274.         }
  1275.     }
  1276.     spin_unlock_irqrestore(&s->lock, flags);
  1277.     return mask;
  1278. }
  1279. static int m3_mmap(struct file *file, struct vm_area_struct *vma)
  1280. {
  1281.     struct m3_state *s = (struct m3_state *)file->private_data;
  1282.     unsigned long max_size, size, start, offset;
  1283.     struct dmabuf *db;
  1284.     int ret = -EINVAL;
  1285.     VALIDATE_STATE(s);
  1286.     if (vma->vm_flags & VM_WRITE) {
  1287.         if ((ret = prog_dmabuf(s, 0)) != 0)
  1288.             return ret;
  1289.         db = &s->dma_dac;
  1290.     } else 
  1291.     if (vma->vm_flags & VM_READ) {
  1292.         if ((ret = prog_dmabuf(s, 1)) != 0)
  1293.             return ret;
  1294.         db = &s->dma_adc;
  1295.     } else  
  1296.         return -EINVAL;
  1297.     max_size = db->dmasize;
  1298.     start = vma->vm_start;
  1299.     offset = (vma->vm_pgoff << PAGE_SHIFT);
  1300.     size = vma->vm_end - vma->vm_start;
  1301.     if(size > max_size)
  1302.         goto out;
  1303.     if(offset > max_size - size)
  1304.         goto out;
  1305.     /*
  1306.      * this will be ->nopage() once I can 
  1307.      * ask Jeff what the hell I'm doing wrong.
  1308.      */
  1309.     ret = -EAGAIN;
  1310.     if (remap_page_range(vma->vm_start, virt_to_phys(db->rawbuf), size, vma->vm_page_prot))
  1311.         goto out;
  1312.     db->mapped = 1;
  1313.     ret = 0;
  1314. out:
  1315.     return ret;
  1316. }
  1317. /*
  1318.  * this function is a disaster..
  1319.  */
  1320. #define get_user_ret(x, ptr,  ret) ({ if(get_user(x, ptr)) return ret; })
  1321. static int m3_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1322. {
  1323.     struct m3_state *s = (struct m3_state *)file->private_data;
  1324.     unsigned long flags;
  1325.     audio_buf_info abinfo;
  1326.     count_info cinfo;
  1327.     int val, mapped, ret;
  1328.     unsigned char fmtm, fmtd;
  1329.     VALIDATE_STATE(s);
  1330.     mapped = ((file->f_mode & FMODE_WRITE) && s->dma_dac.mapped) ||
  1331.         ((file->f_mode & FMODE_READ) && s->dma_adc.mapped);
  1332.     DPRINTK(DPSYS,"m3_ioctl: cmd %dn", cmd);
  1333.     switch (cmd) {
  1334.     case OSS_GETVERSION:
  1335.         return put_user(SOUND_VERSION, (int *)arg);
  1336.     case SNDCTL_DSP_SYNC:
  1337.         if (file->f_mode & FMODE_WRITE)
  1338.             return drain_dac(s, file->f_flags & O_NONBLOCK);
  1339.         return 0;
  1340.         
  1341.     case SNDCTL_DSP_SETDUPLEX:
  1342.         /* XXX fix */
  1343.         return 0;
  1344.     case SNDCTL_DSP_GETCAPS:
  1345.         return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, (int *)arg);
  1346.         
  1347.     case SNDCTL_DSP_RESET:
  1348.         spin_lock_irqsave(&s->lock, flags);
  1349.         if (file->f_mode & FMODE_WRITE) {
  1350.             stop_dac(s);
  1351.             synchronize_irq();
  1352.             s->dma_dac.swptr = s->dma_dac.hwptr = s->dma_dac.count = s->dma_dac.total_bytes = 0;
  1353.         }
  1354.         if (file->f_mode & FMODE_READ) {
  1355.             stop_adc(s);
  1356.             synchronize_irq();
  1357.             s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0;
  1358.         }
  1359.         spin_unlock_irqrestore(&s->lock, flags);
  1360.         return 0;
  1361.     case SNDCTL_DSP_SPEED:
  1362.         get_user_ret(val, (int *)arg, -EFAULT);
  1363.         spin_lock_irqsave(&s->lock, flags);
  1364.         if (val >= 0) {
  1365.             if (file->f_mode & FMODE_READ) {
  1366.                 stop_adc(s);
  1367.                 s->dma_adc.ready = 0;
  1368.                 set_adc_rate(s, val);
  1369.             }
  1370.             if (file->f_mode & FMODE_WRITE) {
  1371.                 stop_dac(s);
  1372.                 s->dma_dac.ready = 0;
  1373.                 set_dac_rate(s, val);
  1374.             }
  1375.         }
  1376.         spin_unlock_irqrestore(&s->lock, flags);
  1377.         return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, (int *)arg);
  1378.         
  1379.     case SNDCTL_DSP_STEREO:
  1380.         get_user_ret(val, (int *)arg, -EFAULT);
  1381.         spin_lock_irqsave(&s->lock, flags);
  1382.         fmtd = 0;
  1383.         fmtm = ~0;
  1384.         if (file->f_mode & FMODE_READ) {
  1385.             stop_adc(s);
  1386.             s->dma_adc.ready = 0;
  1387.             if (val)
  1388.                 fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
  1389.             else
  1390.                 fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
  1391.         }
  1392.         if (file->f_mode & FMODE_WRITE) {
  1393.             stop_dac(s);
  1394.             s->dma_dac.ready = 0;
  1395.             if (val)
  1396.                 fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
  1397.             else
  1398.                 fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
  1399.         }
  1400.         set_fmt(s, fmtm, fmtd);
  1401.         spin_unlock_irqrestore(&s->lock, flags);
  1402.         return 0;
  1403.     case SNDCTL_DSP_CHANNELS:
  1404.         get_user_ret(val, (int *)arg, -EFAULT);
  1405.         spin_lock_irqsave(&s->lock, flags);
  1406.         if (val != 0) {
  1407.             fmtd = 0;
  1408.             fmtm = ~0;
  1409.             if (file->f_mode & FMODE_READ) {
  1410.                 stop_adc(s);
  1411.                 s->dma_adc.ready = 0;
  1412.                 if (val >= 2)
  1413.                     fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
  1414.                 else
  1415.                     fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
  1416.             }
  1417.             if (file->f_mode & FMODE_WRITE) {
  1418.                 stop_dac(s);
  1419.                 s->dma_dac.ready = 0;
  1420.                 if (val >= 2)
  1421.                     fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
  1422.                 else
  1423.                     fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
  1424.             }
  1425.             set_fmt(s, fmtm, fmtd);
  1426.         }
  1427.         spin_unlock_irqrestore(&s->lock, flags);
  1428.         return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT) 
  1429.                        : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, (int *)arg);
  1430.         
  1431.     case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  1432.         return put_user(AFMT_U8|AFMT_S16_LE, (int *)arg);
  1433.         
  1434.     case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  1435.         get_user_ret(val, (int *)arg, -EFAULT);
  1436.         spin_lock_irqsave(&s->lock, flags);
  1437.         if (val != AFMT_QUERY) {
  1438.             fmtd = 0;
  1439.             fmtm = ~0;
  1440.             if (file->f_mode & FMODE_READ) {
  1441.                 stop_adc(s);
  1442.                 s->dma_adc.ready = 0;
  1443.                 if (val == AFMT_S16_LE)
  1444.                     fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
  1445.                 else
  1446.                     fmtm &= ~(ESS_FMT_16BIT << ESS_ADC_SHIFT);
  1447.             }
  1448.             if (file->f_mode & FMODE_WRITE) {
  1449.                 stop_dac(s);
  1450.                 s->dma_dac.ready = 0;
  1451.                 if (val == AFMT_S16_LE)
  1452.                     fmtd |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
  1453.                 else
  1454.                     fmtm &= ~(ESS_FMT_16BIT << ESS_DAC_SHIFT);
  1455.             }
  1456.             set_fmt(s, fmtm, fmtd);
  1457.         }
  1458.         spin_unlock_irqrestore(&s->lock, flags);
  1459.         return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? 
  1460.             (ESS_FMT_16BIT << ESS_ADC_SHIFT) 
  1461.             : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 
  1462.                 AFMT_S16_LE : 
  1463.                 AFMT_U8, 
  1464.             (int *)arg);
  1465.         
  1466.     case SNDCTL_DSP_POST:
  1467.         return 0;
  1468.     case SNDCTL_DSP_GETTRIGGER:
  1469.         val = 0;
  1470.         if ((file->f_mode & FMODE_READ) && (s->enable & ADC_RUNNING))
  1471.             val |= PCM_ENABLE_INPUT;
  1472.         if ((file->f_mode & FMODE_WRITE) && (s->enable & DAC_RUNNING)) 
  1473.             val |= PCM_ENABLE_OUTPUT;
  1474.         return put_user(val, (int *)arg);
  1475.         
  1476.     case SNDCTL_DSP_SETTRIGGER:
  1477.         get_user_ret(val, (int *)arg, -EFAULT);
  1478.         if (file->f_mode & FMODE_READ) {
  1479.             if (val & PCM_ENABLE_INPUT) {
  1480.                 if (!s->dma_adc.ready && (ret =  prog_dmabuf(s, 1)))
  1481.                     return ret;
  1482.                 start_adc(s);
  1483.             } else
  1484.                 stop_adc(s);
  1485.         }
  1486.         if (file->f_mode & FMODE_WRITE) {
  1487.             if (val & PCM_ENABLE_OUTPUT) {
  1488.                 if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
  1489.                     return ret;
  1490.                 start_dac(s);
  1491.             } else
  1492.                 stop_dac(s);
  1493.         }
  1494.         return 0;
  1495.     case SNDCTL_DSP_GETOSPACE:
  1496.         if (!(file->f_mode & FMODE_WRITE))
  1497.             return -EINVAL;
  1498.         if (!(s->enable & DAC_RUNNING) && (val = prog_dmabuf(s, 0)) != 0)
  1499.             return val;
  1500.         spin_lock_irqsave(&s->lock, flags);
  1501.         m3_update_ptr(s);
  1502.         abinfo.fragsize = s->dma_dac.fragsize;
  1503.         abinfo.bytes = s->dma_dac.dmasize - s->dma_dac.count;
  1504.         abinfo.fragstotal = s->dma_dac.numfrag;
  1505.         abinfo.fragments = abinfo.bytes >> s->dma_dac.fragshift;      
  1506.         spin_unlock_irqrestore(&s->lock, flags);
  1507.         return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1508.     case SNDCTL_DSP_GETISPACE:
  1509.         if (!(file->f_mode & FMODE_READ))
  1510.             return -EINVAL;
  1511.         if (!(s->enable & ADC_RUNNING) && (val = prog_dmabuf(s, 1)) != 0)
  1512.             return val;
  1513.         spin_lock_irqsave(&s->lock, flags);
  1514.         m3_update_ptr(s);
  1515.         abinfo.fragsize = s->dma_adc.fragsize;
  1516.         abinfo.bytes = s->dma_adc.count;
  1517.         abinfo.fragstotal = s->dma_adc.numfrag;
  1518.         abinfo.fragments = abinfo.bytes >> s->dma_adc.fragshift;      
  1519.         spin_unlock_irqrestore(&s->lock, flags);
  1520.         return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1521.         
  1522.     case SNDCTL_DSP_NONBLOCK:
  1523.         file->f_flags |= O_NONBLOCK;
  1524.         return 0;
  1525.     case SNDCTL_DSP_GETODELAY:
  1526.         if (!(file->f_mode & FMODE_WRITE))
  1527.             return -EINVAL;
  1528.         spin_lock_irqsave(&s->lock, flags);
  1529.         m3_update_ptr(s);
  1530.         val = s->dma_dac.count;
  1531.         spin_unlock_irqrestore(&s->lock, flags);
  1532.         return put_user(val, (int *)arg);
  1533.     case SNDCTL_DSP_GETIPTR:
  1534.         if (!(file->f_mode & FMODE_READ))
  1535.             return -EINVAL;
  1536.         spin_lock_irqsave(&s->lock, flags);
  1537.         m3_update_ptr(s);
  1538.         cinfo.bytes = s->dma_adc.total_bytes;
  1539.         cinfo.blocks = s->dma_adc.count >> s->dma_adc.fragshift;
  1540.         cinfo.ptr = s->dma_adc.hwptr;
  1541.         if (s->dma_adc.mapped)
  1542.             s->dma_adc.count &= s->dma_adc.fragsize-1;
  1543.         spin_unlock_irqrestore(&s->lock, flags);
  1544.         return copy_to_user((void *)arg, &cinfo, sizeof(cinfo)) ? -EFAULT : 0;
  1545.     case SNDCTL_DSP_GETOPTR:
  1546.         if (!(file->f_mode & FMODE_WRITE))
  1547.             return -EINVAL;
  1548.         spin_lock_irqsave(&s->lock, flags);
  1549.         m3_update_ptr(s);
  1550.         cinfo.bytes = s->dma_dac.total_bytes;
  1551.         cinfo.blocks = s->dma_dac.count >> s->dma_dac.fragshift;
  1552.         cinfo.ptr = s->dma_dac.hwptr;
  1553.         if (s->dma_dac.mapped)
  1554.             s->dma_dac.count &= s->dma_dac.fragsize-1;
  1555.         spin_unlock_irqrestore(&s->lock, flags);
  1556.         return copy_to_user((void *)arg, &cinfo, sizeof(cinfo)) ? -EFAULT : 0;
  1557.     case SNDCTL_DSP_GETBLKSIZE:
  1558.         if (file->f_mode & FMODE_WRITE) {
  1559.             if ((val = prog_dmabuf(s, 0)))
  1560.                 return val;
  1561.             return put_user(s->dma_dac.fragsize, (int *)arg);
  1562.         }
  1563.         if ((val = prog_dmabuf(s, 1)))
  1564.             return val;
  1565.         return put_user(s->dma_adc.fragsize, (int *)arg);
  1566.     case SNDCTL_DSP_SETFRAGMENT:
  1567.         get_user_ret(val, (int *)arg, -EFAULT);
  1568.         spin_lock_irqsave(&s->lock, flags);
  1569.         if (file->f_mode & FMODE_READ) {
  1570.             s->dma_adc.ossfragshift = val & 0xffff;
  1571.             s->dma_adc.ossmaxfrags = (val >> 16) & 0xffff;
  1572.             if (s->dma_adc.ossfragshift < 4)
  1573.                 s->dma_adc.ossfragshift = 4;
  1574.             if (s->dma_adc.ossfragshift > 15)
  1575.                 s->dma_adc.ossfragshift = 15;
  1576.             if (s->dma_adc.ossmaxfrags < 4)
  1577.                 s->dma_adc.ossmaxfrags = 4;
  1578.         }
  1579.         if (file->f_mode & FMODE_WRITE) {
  1580.             s->dma_dac.ossfragshift = val & 0xffff;
  1581.             s->dma_dac.ossmaxfrags = (val >> 16) & 0xffff;
  1582.             if (s->dma_dac.ossfragshift < 4)
  1583.                 s->dma_dac.ossfragshift = 4;
  1584.             if (s->dma_dac.ossfragshift > 15)
  1585.                 s->dma_dac.ossfragshift = 15;
  1586.             if (s->dma_dac.ossmaxfrags < 4)
  1587.                 s->dma_dac.ossmaxfrags = 4;
  1588.         }
  1589.         spin_unlock_irqrestore(&s->lock, flags);
  1590.         return 0;
  1591.     case SNDCTL_DSP_SUBDIVIDE:
  1592.         if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
  1593.             (file->f_mode & FMODE_WRITE && s->dma_dac.subdivision))
  1594.             return -EINVAL;
  1595.                 get_user_ret(val, (int *)arg, -EFAULT);
  1596.         if (val != 1 && val != 2 && val != 4)
  1597.             return -EINVAL;
  1598.         if (file->f_mode & FMODE_READ)
  1599.             s->dma_adc.subdivision = val;
  1600.         if (file->f_mode & FMODE_WRITE)
  1601.             s->dma_dac.subdivision = val;
  1602.         return 0;
  1603.     case SOUND_PCM_READ_RATE:
  1604.         return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, (int *)arg);
  1605.     case SOUND_PCM_READ_CHANNELS:
  1606.         return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT) 
  1607.                        : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, (int *)arg);
  1608.     case SOUND_PCM_READ_BITS:
  1609.         return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_16BIT << ESS_ADC_SHIFT) 
  1610.                        : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 16 : 8, (int *)arg);
  1611.     case SOUND_PCM_WRITE_FILTER:
  1612.     case SNDCTL_DSP_SETSYNCRO:
  1613.     case SOUND_PCM_READ_FILTER:
  1614.         return -EINVAL;
  1615.         
  1616.     }
  1617.     return -EINVAL;
  1618. }
  1619. static int
  1620. allocate_dmabuf(struct pci_dev *pci_dev, struct dmabuf *db)
  1621. {
  1622.     int order;
  1623.     DPRINTK(DPSTR,"allocating for dmabuf %pn", db);
  1624.     /* 
  1625.      * alloc as big a chunk as we can, start with 
  1626.      * 64k 'cause we're insane.  based on order cause
  1627.      * the amazingly complicated prog_dmabuf wants it.
  1628.      *
  1629.      * pci_alloc_sonsistent guarantees that it won't cross a natural
  1630.      * boundry; the m3 hardware can't have dma cross a 64k bus
  1631.      * address boundry.
  1632.      */
  1633.     for (order = 16-PAGE_SHIFT; order >= 1; order--) {
  1634.         db->rawbuf = pci_alloc_consistent(pci_dev, PAGE_SIZE << order,
  1635.                         &(db->handle));
  1636.         if(db->rawbuf)
  1637.             break;
  1638.     }
  1639.     if (!db->rawbuf)
  1640.         return 1;
  1641.     DPRINTK(DPSTR,"allocated %ld (%d) bytes at %pn",
  1642.             PAGE_SIZE<<order, order, db->rawbuf);
  1643.     {
  1644.         struct page *page, *pend;
  1645.         pend = virt_to_page(db->rawbuf + (PAGE_SIZE << order) - 1);
  1646.         for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  1647.             mem_map_reserve(page);
  1648.     }
  1649.     db->buforder = order;
  1650.     db->ready = 0;
  1651.     db->mapped = 0;
  1652.     return 0;
  1653. }
  1654. static void
  1655. nuke_lists(struct m3_card *card, struct dmabuf *db)
  1656. {
  1657.     m3_remove_list(card, &(card->dma_list), db->dma_index);
  1658.     m3_remove_list(card, &(card->msrc_list), db->msrc_index);
  1659.     db->in_lists = 0;
  1660. }
  1661. static void
  1662. free_dmabuf(struct pci_dev *pci_dev, struct dmabuf *db)
  1663. {
  1664.     if(db->rawbuf == NULL)
  1665.         return;
  1666.     DPRINTK(DPSTR,"freeing %p from dmabuf %pn",db->rawbuf, db);
  1667.     {
  1668.         struct page *page, *pend;
  1669.         pend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1);
  1670.         for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  1671.             mem_map_unreserve(page);
  1672.     }
  1673.     pci_free_consistent(pci_dev, PAGE_SIZE << db->buforder,
  1674.             db->rawbuf, db->handle);
  1675.     db->rawbuf = NULL;
  1676.     db->buforder = 0;
  1677.     db->mapped = 0;
  1678.     db->ready = 0;
  1679. }
  1680. static int m3_open(struct inode *inode, struct file *file)
  1681. {
  1682.     int minor = MINOR(inode->i_rdev);
  1683.     struct m3_card *c;
  1684.     struct m3_state *s = NULL;
  1685.     int i;
  1686.     unsigned char fmtm = ~0, fmts = 0;
  1687.     unsigned long flags;
  1688.     /*
  1689.      *    Scan the cards and find the channel. We only
  1690.      *    do this at open time so it is ok
  1691.      */
  1692.     for(c = devs ; c != NULL ; c = c->next) {
  1693.         for(i=0;i<NR_DSPS;i++) {
  1694.             if(c->channels[i].dev_audio < 0)
  1695.                 continue;
  1696.             if((c->channels[i].dev_audio ^ minor) & ~0xf)
  1697.                 continue;
  1698.             s = &c->channels[i];
  1699.             break;
  1700.         }
  1701.     }
  1702.         
  1703.     if (!s)
  1704.         return -ENODEV;
  1705.         
  1706.     VALIDATE_STATE(s);
  1707.     file->private_data = s;
  1708.     /* wait for device to become free */
  1709.     down(&s->open_sem);
  1710.     while (s->open_mode & file->f_mode) {
  1711.         if (file->f_flags & O_NONBLOCK) {
  1712.             up(&s->open_sem);
  1713.             return -EWOULDBLOCK;
  1714.         }
  1715.         up(&s->open_sem);
  1716.         interruptible_sleep_on(&s->open_wait);
  1717.         if (signal_pending(current))
  1718.             return -ERESTARTSYS;
  1719.         down(&s->open_sem);
  1720.     }
  1721.     
  1722.     spin_lock_irqsave(&s->lock, flags);
  1723.     if (file->f_mode & FMODE_READ) {
  1724.         fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_ADC_SHIFT);
  1725.         if ((minor & 0xf) == SND_DEV_DSP16)
  1726.             fmts |= ESS_FMT_16BIT << ESS_ADC_SHIFT; 
  1727.         s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0;
  1728.         set_adc_rate(s, 8000);
  1729.     }
  1730.     if (file->f_mode & FMODE_WRITE) {
  1731.         fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_DAC_SHIFT);
  1732.         if ((minor & 0xf) == SND_DEV_DSP16)
  1733.             fmts |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
  1734.         s->dma_dac.ossfragshift = s->dma_dac.ossmaxfrags = s->dma_dac.subdivision = 0;
  1735.         set_dac_rate(s, 8000);
  1736.     }
  1737.     set_fmt(s, fmtm, fmts);
  1738.     s->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
  1739.     MOD_INC_USE_COUNT;
  1740.     up(&s->open_sem);
  1741.     spin_unlock_irqrestore(&s->lock, flags);
  1742.     return 0;
  1743. }
  1744. static int m3_release(struct inode *inode, struct file *file)
  1745. {
  1746.     struct m3_state *s = (struct m3_state *)file->private_data;
  1747.     unsigned long flags;
  1748.     VALIDATE_STATE(s);
  1749.     if (file->f_mode & FMODE_WRITE)
  1750.         drain_dac(s, file->f_flags & O_NONBLOCK);
  1751.     down(&s->open_sem);
  1752.     spin_lock_irqsave(&s->lock, flags);
  1753.     if (file->f_mode & FMODE_WRITE) {
  1754.         stop_dac(s);
  1755.         if(s->dma_dac.in_lists) {
  1756.             m3_remove_list(s->card, &(s->card->mixer_list), s->dma_dac.mixer_index);
  1757.             nuke_lists(s->card, &(s->dma_dac));
  1758.         }
  1759.     }
  1760.     if (file->f_mode & FMODE_READ) {
  1761.         stop_adc(s);
  1762.         if(s->dma_adc.in_lists) {
  1763.             m3_remove_list(s->card, &(s->card->adc1_list), s->dma_adc.adc1_index);
  1764.             nuke_lists(s->card, &(s->dma_adc));
  1765.         }
  1766.     }
  1767.         
  1768.     s->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
  1769.     spin_unlock_irqrestore(&s->lock, flags);
  1770.     up(&s->open_sem);
  1771.     wake_up(&s->open_wait);
  1772.     MOD_DEC_USE_COUNT;
  1773.     return 0;
  1774. }
  1775. /*
  1776.  * Wait for the ac97 serial bus to be free.
  1777.  * return nonzero if the bus is still busy.
  1778.  */
  1779. static int m3_ac97_wait(struct m3_card *card)
  1780. {
  1781.     int i = 10000;
  1782.     while( (m3_inb(card, 0x30) & 1) && i--) ;
  1783.     return i == 0;
  1784. }
  1785. u16 m3_ac97_read(struct ac97_codec *codec, u8 reg)
  1786. {
  1787.     u16 ret = 0;
  1788.     struct m3_card *card = codec->private_data;
  1789.     spin_lock(&card->ac97_lock);
  1790.     if(m3_ac97_wait(card)) {
  1791.         printk(KERN_ERR PFX "serial bus busy reading reg 0x%xn",reg);
  1792.         goto out;
  1793.     }
  1794.     m3_outb(card, 0x80 | (reg & 0x7f), 0x30);
  1795.     if(m3_ac97_wait(card)) {
  1796.         printk(KERN_ERR PFX "serial bus busy finishing read reg 0x%xn",reg);
  1797.         goto out;
  1798.     }
  1799.     ret =  m3_inw(card, 0x32);
  1800.     DPRINTK(DPCRAP,"reading 0x%04x from 0x%02xn",ret, reg);
  1801. out:
  1802.     spin_unlock(&card->ac97_lock);
  1803.     return ret;
  1804. }
  1805. void m3_ac97_write(struct ac97_codec *codec, u8 reg, u16 val)
  1806. {
  1807.     struct m3_card *card = codec->private_data;
  1808.     spin_lock(&card->ac97_lock);
  1809.     if(m3_ac97_wait(card)) {
  1810.         printk(KERN_ERR PFX "serial bus busy writing 0x%x to 0x%xn",val, reg);
  1811.         goto out;
  1812.     }
  1813.     DPRINTK(DPCRAP,"writing 0x%04x  to  0x%02xn", val, reg);
  1814.     m3_outw(card, val, 0x32);
  1815.     m3_outb(card, reg & 0x7f, 0x30);
  1816. out:
  1817.     spin_unlock(&card->ac97_lock);
  1818. }
  1819. /* OSS /dev/mixer file operation methods */
  1820. static int m3_open_mixdev(struct inode *inode, struct file *file)
  1821. {
  1822.     int minor = MINOR(inode->i_rdev);
  1823.     struct m3_card *card = devs;
  1824.     MOD_INC_USE_COUNT;
  1825.     for (card = devs; card != NULL; card = card->next) {
  1826.         if((card->ac97 != NULL) && (card->ac97->dev_mixer == minor))
  1827.                 break;
  1828.     }
  1829.     if (!card) {
  1830.         MOD_DEC_USE_COUNT;
  1831.         return -ENODEV;
  1832.     }
  1833.     file->private_data = card->ac97;
  1834.     return 0;
  1835. }
  1836. static int m3_release_mixdev(struct inode *inode, struct file *file)
  1837. {
  1838.     MOD_DEC_USE_COUNT;
  1839.     return 0;
  1840. }
  1841. static int m3_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd,
  1842.                                     unsigned long arg)
  1843. {
  1844.     struct ac97_codec *codec = (struct ac97_codec *)file->private_data;
  1845.     return codec->mixer_ioctl(codec, cmd, arg);
  1846. }
  1847. static struct file_operations m3_mixer_fops = {
  1848.     llseek:         no_llseek,
  1849.     ioctl:          m3_ioctl_mixdev,
  1850.     open:           m3_open_mixdev,
  1851.     release:        m3_release_mixdev,
  1852. };
  1853. void remote_codec_config(int io, int isremote)
  1854. {
  1855.     isremote = isremote ? 1 : 0;
  1856.     outw(  (inw(io + RING_BUS_CTRL_B) & ~SECOND_CODEC_ID_MASK) | isremote,
  1857.             io + RING_BUS_CTRL_B);
  1858.     outw(  (inw(io + SDO_OUT_DEST_CTRL) & ~COMMAND_ADDR_OUT) | isremote,
  1859.             io + SDO_OUT_DEST_CTRL);
  1860.     outw(  (inw(io + SDO_IN_DEST_CTRL) & ~STATUS_ADDR_IN) | isremote,
  1861.             io + SDO_IN_DEST_CTRL);
  1862. }
  1863. /* 
  1864.  * hack, returns non zero on err 
  1865.  */
  1866. static int try_read_vendor(struct m3_card *card)
  1867. {
  1868.     u16 ret;
  1869.     if(m3_ac97_wait(card)) 
  1870.         return 1;
  1871.     m3_outb(card, 0x80 | (AC97_VENDOR_ID1 & 0x7f), 0x30);
  1872.     if(m3_ac97_wait(card)) 
  1873.         return 1;
  1874.     ret =  m3_inw(card, 0x32);
  1875.     return (ret == 0) || (ret == 0xffff);
  1876. }
  1877. static void m3_codec_reset(struct m3_card *card, int busywait)
  1878. {
  1879.     u16 dir;
  1880.     int delay1 = 0, delay2 = 0, i;
  1881.     int io = card->iobase;
  1882.     switch (card->card_type) {
  1883.         /*
  1884.          * the onboard codec on the allegro seems 
  1885.          * to want to wait a very long time before
  1886.          * coming back to life 
  1887.          */
  1888.         case ESS_ALLEGRO:
  1889.             delay1 = 50;
  1890.             delay2 = 800;
  1891.         break;
  1892.         case ESS_MAESTRO3:
  1893.         case ESS_MAESTRO3HW:
  1894.             delay1 = 20;
  1895.             delay2 = 500;
  1896.         break;
  1897.     }
  1898.     for(i = 0; i < 5; i ++) {
  1899.         dir = inw(io + GPIO_DIRECTION);
  1900.         dir |= 0x10; /* assuming pci bus master? */
  1901.         remote_codec_config(io, 0);
  1902.         outw(IO_SRAM_ENABLE, io + RING_BUS_CTRL_A);
  1903.         udelay(20);
  1904.         outw(dir & ~GPO_PRIMARY_AC97 , io + GPIO_DIRECTION);
  1905.         outw(~GPO_PRIMARY_AC97 , io + GPIO_MASK);
  1906.         outw(0, io + GPIO_DATA);
  1907.         outw(dir | GPO_PRIMARY_AC97, io + GPIO_DIRECTION);
  1908.         if(busywait)  {
  1909.             mdelay(delay1);
  1910.         } else {
  1911.             set_current_state(TASK_UNINTERRUPTIBLE);
  1912.             schedule_timeout((delay1 * HZ) / 1000);
  1913.         }
  1914.         outw(GPO_PRIMARY_AC97, io + GPIO_DATA);
  1915.         udelay(5);
  1916.         /* ok, bring back the ac-link */
  1917.         outw(IO_SRAM_ENABLE | SERIAL_AC_LINK_ENABLE, io + RING_BUS_CTRL_A);
  1918.         outw(~0, io + GPIO_MASK);
  1919.         if(busywait) {
  1920.             mdelay(delay2);
  1921.         } else {
  1922.             set_current_state(TASK_UNINTERRUPTIBLE);
  1923.             schedule_timeout((delay2 * HZ) / 1000);
  1924.         }
  1925.         if(! try_read_vendor(card))
  1926.             break;
  1927.         delay1 += 10;
  1928.         delay2 += 100;
  1929.         DPRINTK(DPMOD, "retrying codec reset with delays of %d and %d msn",
  1930.                 delay1, delay2);
  1931.     }
  1932. #if 0
  1933.     /* more gung-ho reset that doesn't
  1934.      * seem to work anywhere :)
  1935.      */
  1936.     tmp = inw(io + RING_BUS_CTRL_A);
  1937.     outw(RAC_SDFS_ENABLE|LAC_SDFS_ENABLE, io + RING_BUS_CTRL_A);
  1938.     mdelay(20);
  1939.     outw(tmp, io + RING_BUS_CTRL_A);
  1940.     mdelay(50);
  1941. #endif
  1942. }
  1943. static int __init m3_codec_install(struct m3_card *card)
  1944. {
  1945.     struct ac97_codec *codec;
  1946.     if ((codec = kmalloc(sizeof(struct ac97_codec), GFP_KERNEL)) == NULL)
  1947.         return -ENOMEM;
  1948.     memset(codec, 0, sizeof(struct ac97_codec));
  1949.     codec->private_data = card;
  1950.     codec->codec_read = m3_ac97_read;
  1951.     codec->codec_write = m3_ac97_write;
  1952.     /* someday we should support secondary codecs.. */
  1953.     codec->id = 0;
  1954.     if (ac97_probe_codec(codec) == 0) {
  1955.         printk(KERN_ERR PFX "codec probe failedn");
  1956.         kfree(codec);
  1957.         return -1;
  1958.     }
  1959.     if ((codec->dev_mixer = register_sound_mixer(&m3_mixer_fops, -1)) < 0) {
  1960.         printk(KERN_ERR PFX "couldn't register mixer!n");
  1961.         kfree(codec);
  1962.         return -1;
  1963.     }
  1964.     card->ac97 = codec;
  1965.     return 0;
  1966. }
  1967. #define MINISRC_LPF_LEN 10
  1968. static u16 minisrc_lpf[MINISRC_LPF_LEN] = {
  1969.     0X0743, 0X1104, 0X0A4C, 0XF88D, 0X242C,
  1970.     0X1023, 0X1AA9, 0X0B60, 0XEFDD, 0X186F
  1971. };
  1972. static void m3_assp_init(struct m3_card *card)
  1973. {
  1974.     int i;
  1975.     /* zero kernel data */
  1976.     for(i = 0 ; i < (REV_B_DATA_MEMORY_UNIT_LENGTH * NUM_UNITS_KERNEL_DATA) / 2; i++)
  1977.         m3_assp_write(card, MEMTYPE_INTERNAL_DATA, 
  1978.                 KDATA_BASE_ADDR + i, 0);
  1979.     /* zero mixer data? */
  1980.     for(i = 0 ; i < (REV_B_DATA_MEMORY_UNIT_LENGTH * NUM_UNITS_KERNEL_DATA) / 2; i++)
  1981.         m3_assp_write(card, MEMTYPE_INTERNAL_DATA, 
  1982.                 KDATA_BASE_ADDR2 + i, 0);
  1983.     /* init dma pointer */
  1984.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA, 
  1985.             KDATA_CURRENT_DMA, 
  1986.             KDATA_DMA_XFER0);
  1987.     /* write kernel into code memory.. */
  1988.     for(i = 0 ; i < sizeof(assp_kernel_image) / 2; i++) {
  1989.         m3_assp_write(card, MEMTYPE_INTERNAL_CODE, 
  1990.                 REV_B_CODE_MEMORY_BEGIN + i, 
  1991.                 assp_kernel_image[i]);
  1992.     }
  1993.     /*
  1994.      * We only have this one client and we know that 0x400
  1995.      * is free in our kernel's mem map, so lets just
  1996.      * drop it there.  It seems that the minisrc doesn't
  1997.      * need vectors, so we won't bother with them..
  1998.      */
  1999.     for(i = 0 ; i < sizeof(assp_minisrc_image) / 2; i++) {
  2000.         m3_assp_write(card, MEMTYPE_INTERNAL_CODE, 
  2001.                 0x400 + i, 
  2002.                 assp_minisrc_image[i]);
  2003.     }
  2004.     /*
  2005.      * write the coefficients for the low pass filter?
  2006.      */
  2007.     for(i = 0; i < MINISRC_LPF_LEN ; i++) {
  2008.         m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  2009.             0x400 + MINISRC_COEF_LOC + i,
  2010.             minisrc_lpf[i]);
  2011.     }
  2012.     m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  2013.         0x400 + MINISRC_COEF_LOC + MINISRC_LPF_LEN,
  2014.         0x8000);
  2015.     /*
  2016.      * the minisrc is the only thing on
  2017.      * our task list..
  2018.      */
  2019.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA, 
  2020.             KDATA_TASK0, 
  2021.             0x400);
  2022.     /*
  2023.      * init the mixer number..
  2024.      */
  2025.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2026.             KDATA_MIXER_TASK_NUMBER,0);
  2027.     /*
  2028.      * EXTREME KERNEL MASTER VOLUME
  2029.      */
  2030.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2031.         KDATA_DAC_LEFT_VOLUME, ARB_VOLUME);
  2032.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2033.         KDATA_DAC_RIGHT_VOLUME, ARB_VOLUME);
  2034.     card->mixer_list.mem_addr = KDATA_MIXER_XFER0;
  2035.     card->mixer_list.max = MAX_VIRTUAL_MIXER_CHANNELS;
  2036.     card->adc1_list.mem_addr = KDATA_ADC1_XFER0;
  2037.     card->adc1_list.max = MAX_VIRTUAL_ADC1_CHANNELS;
  2038.     card->dma_list.mem_addr = KDATA_DMA_XFER0;
  2039.     card->dma_list.max = MAX_VIRTUAL_DMA_CHANNELS;
  2040.     card->msrc_list.mem_addr = KDATA_INSTANCE0_MINISRC;
  2041.     card->msrc_list.max = MAX_INSTANCE_MINISRC;
  2042. }
  2043. static int setup_msrc(struct m3_card *card,
  2044.         struct assp_instance *inst, int index)
  2045. {
  2046.     int data_bytes = 2 * ( MINISRC_TMP_BUFFER_SIZE / 2 + 
  2047.             MINISRC_IN_BUFFER_SIZE / 2 +
  2048.             1 + MINISRC_OUT_BUFFER_SIZE / 2 + 1 );
  2049.     int address, i;
  2050.     /*
  2051.      * the revb memory map has 0x1100 through 0x1c00
  2052.      * free.  
  2053.      */
  2054.     /*
  2055.      * align instance address to 256 bytes so that it's
  2056.      * shifted list address is aligned.  
  2057.      * list address = (mem address >> 1) >> 7;
  2058.      */
  2059.     data_bytes = (data_bytes + 255) & ~255;
  2060.     address = 0x1100 + ((data_bytes/2) * index);
  2061.     if((address + (data_bytes/2)) >= 0x1c00) {
  2062.         printk(KERN_ERR PFX "no memory for %d bytes at ind %d (addr 0x%x)n",
  2063.                 data_bytes, index, address);
  2064.         return -1;
  2065.     }
  2066.     for(i = 0; i < data_bytes/2 ; i++) 
  2067.         m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2068.                 address + i, 0);
  2069.     inst->code = 0x400;
  2070.     inst->data = address;
  2071.     return 0;
  2072. }
  2073. static int m3_assp_client_init(struct m3_state *s)
  2074. {
  2075.     setup_msrc(s->card, &(s->dac_inst), s->index * 2);
  2076.     setup_msrc(s->card, &(s->adc_inst), (s->index * 2) + 1);
  2077.     return 0;
  2078. }
  2079. static void m3_amp_enable(struct m3_card *card, int enable)
  2080. {
  2081.     /* 
  2082.      * this works for the reference board, have to find
  2083.      * out about others
  2084.      *
  2085.      * this needs more magic for 4 speaker, but..
  2086.      */
  2087.     int io = card->iobase;
  2088.     u16 gpo, polarity_port, polarity;
  2089.     if(!external_amp)
  2090.         return;
  2091.     if (gpio_pin >= 0  && gpio_pin <= 15) {
  2092.         polarity_port = 0x1000 + (0x100 * gpio_pin);
  2093.     } else {
  2094.         switch (card->card_type) {
  2095.             case ESS_ALLEGRO:
  2096.                 polarity_port = 0x1800;
  2097.                 break;
  2098.             default:
  2099.                 polarity_port = 0x1100;
  2100.                 /* Panasonic toughbook CF72 has to be different... */
  2101.                 if(card->pcidev->subsystem_vendor == 0x10F7 && card->pcidev->subsystem_device == 0x833D)
  2102.                  polarity_port = 0x1D00;
  2103.                 break;
  2104.         }
  2105.     }
  2106.     gpo = (polarity_port >> 8) & 0x0F;
  2107.     polarity = polarity_port >> 12;
  2108.     if ( enable )
  2109.         polarity = !polarity;
  2110.     polarity = polarity << gpo;
  2111.     gpo = 1 << gpo;
  2112.     outw(~gpo , io + GPIO_MASK);
  2113.     outw( inw(io + GPIO_DIRECTION) | gpo ,
  2114.             io + GPIO_DIRECTION);
  2115.     outw( (GPO_SECONDARY_AC97 | GPO_PRIMARY_AC97 | polarity) ,
  2116.             io + GPIO_DATA);
  2117.     outw(0xffff , io + GPIO_MASK);
  2118. }
  2119. static int
  2120. maestro_config(struct m3_card *card) 
  2121. {
  2122.     struct pci_dev *pcidev = card->pcidev;
  2123.     u32 n;
  2124.     u8  t; /* makes as much sense as 'n', no? */
  2125.     pci_read_config_dword(pcidev, PCI_ALLEGRO_CONFIG, &n);
  2126.     n &= REDUCED_DEBOUNCE;
  2127.     n |= PM_CTRL_ENABLE | CLK_DIV_BY_49 | USE_PCI_TIMING;
  2128.     pci_write_config_dword(pcidev, PCI_ALLEGRO_CONFIG, n);
  2129.     outb(RESET_ASSP, card->iobase + ASSP_CONTROL_B);
  2130.     pci_read_config_dword(pcidev, PCI_ALLEGRO_CONFIG, &n);
  2131.     n &= ~INT_CLK_SELECT;
  2132.     if(card->card_type >= ESS_MAESTRO3)  {
  2133.         n &= ~INT_CLK_MULT_ENABLE; 
  2134.         n |= INT_CLK_SRC_NOT_PCI;
  2135.     }
  2136.     n &=  ~( CLK_MULT_MODE_SELECT | CLK_MULT_MODE_SELECT_2 );
  2137.     pci_write_config_dword(pcidev, PCI_ALLEGRO_CONFIG, n);
  2138.     if(card->card_type <= ESS_ALLEGRO) {
  2139.         pci_read_config_dword(pcidev, PCI_USER_CONFIG, &n);
  2140.         n |= IN_CLK_12MHZ_SELECT;
  2141.         pci_write_config_dword(pcidev, PCI_USER_CONFIG, n);
  2142.     }
  2143.     t = inb(card->iobase + ASSP_CONTROL_A);
  2144.     t &= ~( DSP_CLK_36MHZ_SELECT  | ASSP_CLK_49MHZ_SELECT);
  2145.     t |= ASSP_CLK_49MHZ_SELECT;
  2146.     t |= ASSP_0_WS_ENABLE; 
  2147.     outb(t, card->iobase + ASSP_CONTROL_A);
  2148.     outb(RUN_ASSP, card->iobase + ASSP_CONTROL_B); 
  2149.     return 0;
  2150. static void m3_enable_ints(struct m3_card *card)
  2151. {
  2152.     unsigned long io = card->iobase;
  2153.     outw(ASSP_INT_ENABLE, io + HOST_INT_CTRL);
  2154.     outb(inb(io + ASSP_CONTROL_C) | ASSP_HOST_INT_ENABLE,
  2155.             io + ASSP_CONTROL_C);
  2156. }
  2157. static struct file_operations m3_audio_fops = {
  2158.     llseek:     &no_llseek,
  2159.     read:       &m3_read,
  2160.     write:      &m3_write,
  2161.     poll:       &m3_poll,
  2162.     ioctl:      &m3_ioctl,
  2163.     mmap:       &m3_mmap,
  2164.     open:       &m3_open,
  2165.     release:    &m3_release,
  2166. };
  2167. #ifdef CONFIG_PM
  2168. int alloc_dsp_suspendmem(struct m3_card *card)
  2169. {
  2170.     int len = sizeof(u16) * (REV_B_CODE_MEMORY_LENGTH + REV_B_DATA_MEMORY_LENGTH);
  2171.     if( (card->suspend_mem = vmalloc(len)) == NULL)
  2172.         return 1;
  2173.     return 0;
  2174. }
  2175. void free_dsp_suspendmem(struct m3_card *card)
  2176. {
  2177.    if(card->suspend_mem)
  2178.        vfree(card->suspend_mem);
  2179. }
  2180. #else
  2181. #define alloc_dsp_suspendmem(args...) 0
  2182. #define free_dsp_suspendmem(args...) 
  2183. #endif
  2184. /*
  2185.  * great day!  this function is ugly as hell.
  2186.  */
  2187. static int __init m3_probe(struct pci_dev *pci_dev, const struct pci_device_id *pci_id)
  2188. {
  2189.     u32 n;
  2190.     int i;
  2191.     struct m3_card *card = NULL;
  2192.     int ret = 0;
  2193.     int card_type = pci_id->driver_data;
  2194.     DPRINTK(DPMOD, "in maestro_installn");
  2195.     if (pci_enable_device(pci_dev))
  2196.         return -EIO;
  2197.     if (pci_set_dma_mask(pci_dev, M3_PCI_DMA_MASK)) {
  2198.         printk(KERN_ERR PFX "architecture does not support limiting to 28bit PCI bus addressesn");
  2199.         return -ENODEV;
  2200.     }
  2201.         
  2202.     pci_set_master(pci_dev);
  2203.     if( (card = kmalloc(sizeof(struct m3_card), GFP_KERNEL)) == NULL) {
  2204.         printk(KERN_WARNING PFX "out of memoryn");
  2205.         return -ENOMEM;
  2206.     }
  2207.     memset(card, 0, sizeof(struct m3_card));
  2208.     card->pcidev = pci_dev;
  2209.     init_waitqueue_head(&card->suspend_queue);
  2210.     if ( ! request_region(pci_resource_start(pci_dev, 0),
  2211.                 pci_resource_len (pci_dev, 0), M3_MODULE_NAME)) {
  2212.         printk(KERN_WARNING PFX "unable to reserve I/O space.n");
  2213.         ret = -EBUSY;
  2214.         goto out;
  2215.     }
  2216.     card->iobase = pci_resource_start(pci_dev, 0);
  2217.     if(alloc_dsp_suspendmem(card)) {
  2218.         printk(KERN_WARNING PFX "couldn't alloc %d bytes for saving dsp state on suspendn",
  2219.                 REV_B_CODE_MEMORY_LENGTH + REV_B_DATA_MEMORY_LENGTH);
  2220.         ret = -ENOMEM;
  2221.         goto out;
  2222.     }
  2223.     card->card_type = card_type;
  2224.     card->irq = pci_dev->irq;
  2225.     card->next = devs;
  2226.     card->magic = M3_CARD_MAGIC;
  2227.     spin_lock_init(&card->lock);
  2228.     spin_lock_init(&card->ac97_lock);
  2229.     devs = card;
  2230.     for(i = 0; i<NR_DSPS; i++) {
  2231.         struct m3_state *s = &(card->channels[i]);
  2232.         s->dev_audio = -1;
  2233.     }
  2234.     printk(KERN_INFO PFX "Configuring ESS %s found at IO 0x%04X IRQ %dn", 
  2235.         card_names[card->card_type], card->iobase, card->irq);
  2236.     pci_read_config_dword(pci_dev, PCI_SUBSYSTEM_VENDOR_ID, &n);
  2237.     printk(KERN_INFO PFX " subvendor id: 0x%08xn",n); 
  2238.     maestro_config(card);
  2239.     m3_assp_halt(card);
  2240.     m3_codec_reset(card, 0);
  2241.     if(m3_codec_install(card))  {
  2242.         ret = -EIO; 
  2243.         goto out;
  2244.     }
  2245.     m3_assp_init(card);
  2246.     m3_amp_enable(card, 1);
  2247.     
  2248.     for(i=0;i<NR_DSPS;i++) {
  2249.         struct m3_state *s=&card->channels[i];
  2250.         s->index = i;
  2251.         s->card = card;
  2252.         init_waitqueue_head(&s->dma_adc.wait);
  2253.         init_waitqueue_head(&s->dma_dac.wait);
  2254.         init_waitqueue_head(&s->open_wait);
  2255.         spin_lock_init(&s->lock);
  2256.         init_MUTEX(&(s->open_sem));
  2257.         s->magic = M3_STATE_MAGIC;
  2258.         m3_assp_client_init(s);
  2259.         
  2260.         if(s->dma_adc.ready || s->dma_dac.ready || s->dma_adc.rawbuf)
  2261.             printk(KERN_WARNING PFX "initing a dsp device that is already in use?n");
  2262.         /* register devices */
  2263.         if ((s->dev_audio = register_sound_dsp(&m3_audio_fops, -1)) < 0) {
  2264.             break;
  2265.         }
  2266.         if( allocate_dmabuf(card->pcidev, &(s->dma_adc)) ||
  2267.                 allocate_dmabuf(card->pcidev, &(s->dma_dac)))  { 
  2268.             ret = -ENOMEM;
  2269.             goto out;
  2270.         }
  2271.     }
  2272.     
  2273.     if(request_irq(card->irq, m3_interrupt, SA_SHIRQ, card_names[card->card_type], card)) {
  2274.         printk(KERN_ERR PFX "unable to allocate irq %d,n", card->irq);
  2275.         ret = -EIO;
  2276.         goto out;
  2277.     }
  2278.     pci_set_drvdata(pci_dev, card);
  2279.     
  2280.     m3_enable_ints(card);
  2281.     m3_assp_continue(card);
  2282. out:
  2283.     if(ret) {
  2284.         if(card->iobase)
  2285.             release_region(pci_resource_start(pci_dev, 0), pci_resource_len(pci_dev, 0));
  2286.         free_dsp_suspendmem(card);
  2287.         if(card->ac97) {
  2288.             unregister_sound_mixer(card->ac97->dev_mixer);
  2289.             kfree(card->ac97);
  2290.         }
  2291.         for(i=0;i<NR_DSPS;i++)
  2292.         {
  2293.             struct m3_state *s = &card->channels[i];
  2294.             if(s->dev_audio != -1)
  2295.                 unregister_sound_dsp(s->dev_audio);
  2296.         }
  2297.         kfree(card);
  2298.     }
  2299.     return ret; 
  2300. }
  2301. static void m3_remove(struct pci_dev *pci_dev)
  2302. {
  2303.     struct m3_card *card;
  2304.     unregister_reboot_notifier(&m3_reboot_nb);
  2305.     while ((card = devs)) {
  2306.         int i;
  2307.         devs = devs->next;
  2308.     
  2309.         free_irq(card->irq, card);
  2310.         unregister_sound_mixer(card->ac97->dev_mixer);
  2311.         kfree(card->ac97);
  2312.         for(i=0;i<NR_DSPS;i++)
  2313.         {
  2314.             struct m3_state *s = &card->channels[i];
  2315.             if(s->dev_audio < 0)
  2316.                 continue;
  2317.             unregister_sound_dsp(s->dev_audio);
  2318.             free_dmabuf(card->pcidev, &s->dma_adc);
  2319.             free_dmabuf(card->pcidev, &s->dma_dac);
  2320.         }
  2321.         release_region(card->iobase, 256);
  2322.         free_dsp_suspendmem(card);
  2323.         kfree(card);
  2324.     }
  2325.     devs = NULL;
  2326. }
  2327. /*
  2328.  * some bioses like the sound chip to be powered down
  2329.  * at shutdown.  We're just calling _suspend to
  2330.  * achieve that..
  2331.  */
  2332. static int m3_notifier(struct notifier_block *nb, unsigned long event, void *buf)
  2333. {
  2334.     struct m3_card *card;
  2335.     DPRINTK(DPMOD, "notifier suspending all cardsn");
  2336.     for(card = devs; card != NULL; card = card->next) {
  2337.         if(!card->in_suspend)
  2338.             m3_suspend(card->pcidev, 3); /* XXX legal? */
  2339.     }
  2340.     return 0;
  2341. }
  2342. static int m3_suspend(struct pci_dev *pci_dev, u32 state)
  2343. {
  2344.     unsigned long flags;
  2345.     int i;
  2346.     struct m3_card *card = pci_get_drvdata(pci_dev);
  2347.     /* must be a better way.. */
  2348.     save_flags(flags);
  2349.     cli();
  2350.     DPRINTK(DPMOD, "pm in dev %pn",card);
  2351.     for(i=0;i<NR_DSPS;i++) {
  2352.         struct m3_state *s = &card->channels[i];
  2353.         if(s->dev_audio == -1)
  2354.             continue;
  2355.         DPRINTK(DPMOD, "stop_adc/dac() device %dn",i);
  2356.         stop_dac(s);
  2357.         stop_adc(s);
  2358.     }
  2359.     mdelay(10); /* give the assp a chance to idle.. */
  2360.     m3_assp_halt(card);
  2361.     if(card->suspend_mem) {
  2362.         int index = 0;
  2363.         DPRINTK(DPMOD, "saving coden");
  2364.         for(i = REV_B_CODE_MEMORY_BEGIN ; i <= REV_B_CODE_MEMORY_END; i++)
  2365.             card->suspend_mem[index++] = 
  2366.                 m3_assp_read(card, MEMTYPE_INTERNAL_CODE, i);
  2367.         DPRINTK(DPMOD, "saving datan");
  2368.         for(i = REV_B_DATA_MEMORY_BEGIN ; i <= REV_B_DATA_MEMORY_END; i++)
  2369.             card->suspend_mem[index++] = 
  2370.                 m3_assp_read(card, MEMTYPE_INTERNAL_DATA, i);
  2371.     }
  2372.     DPRINTK(DPMOD, "powering down apci regsn");
  2373.     m3_outw(card, 0xffff, 0x54);
  2374.     m3_outw(card, 0xffff, 0x56);
  2375.     card->in_suspend = 1;
  2376.     restore_flags(flags);
  2377.     return 0;
  2378. }
  2379. static int m3_resume(struct pci_dev *pci_dev)
  2380. {
  2381.     unsigned long flags;
  2382.     int index;
  2383.     int i;
  2384.     struct m3_card *card = pci_get_drvdata(pci_dev);
  2385.     save_flags(flags); /* paranoia */
  2386.     cli();
  2387.     card->in_suspend = 0;
  2388.     DPRINTK(DPMOD, "resumingn");
  2389.     /* first lets just bring everything back. .*/
  2390.     DPRINTK(DPMOD, "bringing power back on card 0x%pn",card);
  2391.     m3_outw(card, 0, 0x54);
  2392.     m3_outw(card, 0, 0x56);
  2393.     DPRINTK(DPMOD, "restoring pci configs and reseting codecn");
  2394.     maestro_config(card);
  2395.     m3_assp_halt(card);
  2396.     m3_codec_reset(card, 1);
  2397.     DPRINTK(DPMOD, "restoring dsp code cardn");
  2398.     index = 0;
  2399.     for(i = REV_B_CODE_MEMORY_BEGIN ; i <= REV_B_CODE_MEMORY_END; i++)
  2400.         m3_assp_write(card, MEMTYPE_INTERNAL_CODE, i, 
  2401.             card->suspend_mem[index++]);
  2402.     for(i = REV_B_DATA_MEMORY_BEGIN ; i <= REV_B_DATA_MEMORY_END; i++)
  2403.         m3_assp_write(card, MEMTYPE_INTERNAL_DATA, i, 
  2404.             card->suspend_mem[index++]);
  2405.      /* tell the dma engine to restart itself */
  2406.     m3_assp_write(card, MEMTYPE_INTERNAL_DATA, 
  2407.         KDATA_DMA_ACTIVE, 0);
  2408.     DPRINTK(DPMOD, "resuming dspn");
  2409.     m3_assp_continue(card);
  2410.     DPRINTK(DPMOD, "enabling intsn");
  2411.     m3_enable_ints(card);
  2412.     /* bring back the old school flavor */
  2413.     for(i = 0; i < SOUND_MIXER_NRDEVICES ; i++) {
  2414.         int state = card->ac97->mixer_state[i];
  2415.         if (!supported_mixer(card->ac97, i)) 
  2416.                 continue;
  2417.         card->ac97->write_mixer(card->ac97, i, 
  2418.                 state & 0xff, (state >> 8) & 0xff);
  2419.     }
  2420.     m3_amp_enable(card, 1);
  2421.     /* 
  2422.      * now we flip on the music 
  2423.      */
  2424.     for(i=0;i<NR_DSPS;i++) {
  2425.         struct m3_state *s = &card->channels[i];
  2426.         if(s->dev_audio == -1)
  2427.             continue;
  2428.         /*
  2429.          * db->ready makes it so these guys can be
  2430.          * called unconditionally..
  2431.          */
  2432.         DPRINTK(DPMOD, "turning on dacs ind %dn",i);
  2433.         start_dac(s);    
  2434.         start_adc(s);    
  2435.     }
  2436.     restore_flags(flags);
  2437.     /* 
  2438.      * all right, we think things are ready, 
  2439.      * wake up people who were using the device 
  2440.      * when we suspended
  2441.      */
  2442.     wake_up(&card->suspend_queue);
  2443.     return 0;
  2444. }
  2445. MODULE_AUTHOR("Zach Brown <zab@zabbo.net>");
  2446. MODULE_DESCRIPTION("ESS Maestro3/Allegro Driver");
  2447. MODULE_LICENSE("GPL");
  2448. #ifdef M_DEBUG
  2449. MODULE_PARM(debug,"i");
  2450. #endif
  2451. MODULE_PARM(external_amp,"i");
  2452. MODULE_PARM(gpio_pin, "i");
  2453. static struct pci_driver m3_pci_driver = {
  2454.     name:       "ess_m3_audio",
  2455.     id_table:   m3_id_table,
  2456.     probe:      m3_probe,
  2457.     remove:     m3_remove,
  2458.     suspend:    m3_suspend,
  2459.     resume:     m3_resume,
  2460. };
  2461. static int __init m3_init_module(void)
  2462. {
  2463.     if (!pci_present())   /* No PCI bus in this machine! */
  2464.         return -ENODEV;
  2465.     printk(KERN_INFO PFX "version " DRIVER_VERSION " built at " __TIME__ " " __DATE__ "n");
  2466.     if (register_reboot_notifier(&m3_reboot_nb)) {
  2467.         printk(KERN_WARNING PFX "reboot notifier registration failedn");
  2468.         return -ENODEV; /* ? */
  2469.     }
  2470.     if (!pci_register_driver(&m3_pci_driver)) {
  2471.         pci_unregister_driver(&m3_pci_driver);
  2472.         unregister_reboot_notifier(&m3_reboot_nb);
  2473.         return -ENODEV;
  2474.     }
  2475.     return 0;
  2476. }
  2477. static void __exit m3_cleanup_module(void)
  2478. {
  2479.     pci_unregister_driver(&m3_pci_driver);
  2480. }
  2481. module_init(m3_init_module);
  2482. module_exit(m3_cleanup_module);
  2483. void check_suspend(struct m3_card *card)
  2484. {
  2485.     DECLARE_WAITQUEUE(wait, current);
  2486.     if(!card->in_suspend) 
  2487.         return;
  2488.     card->in_suspend++;
  2489.     add_wait_queue(&card->suspend_queue, &wait);
  2490.     set_current_state(TASK_UNINTERRUPTIBLE);
  2491.     schedule();
  2492.     remove_wait_queue(&card->suspend_queue, &wait);
  2493.     set_current_state(TASK_RUNNING);
  2494. }