开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
rme96xx.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：40k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

rme96xx.c：源码内容
  1. /* (C) 2000 Guenter Geiger <geiger@debian.org>
  2.    with copy/pastes from the driver of Winfried Ritsch <ritsch@iem.kug.ac.at>
  3.    based on es1370.c
  7.    *  10 Jan 2001: 0.1 initial version
  8.    *  19 Jan 2001: 0.2 fixed bug in select()
  9.    *  27 Apr 2001: 0.3 more than one card usable
  10.    *  11 May 2001: 0.4 fixed for SMP, included into kernel source tree
  11.    *  17 May 2001: 0.5 draining code didn't work on new cards
  12.    *  18 May 2001: 0.6 remove synchronize_irq() call 
  14. TODO:
  15.    - test more than one card --- done
  16.    - check for pci IOREGION (see es1370) in rme96xx_probe ??
  17.    - error detection
  18.    - mmap interface
  19.    - mixer mmap interface
  20.    - mixer ioctl
  21.    - get rid of noise upon first open (why ??)
  22.    - allow multiple open(at least for read)
  23.    - allow multiple open for non overlapping regions
  24.    - recheck the multiple devices part (offsets of different devices, etc)
  25.    - do decent draining in _release --- done
  26.    - SMP support
  27. */
  29. #ifndef RMEVERSION
  30. #define RMEVERSION "0.6"
  31. #endif
  33. #include <linux/version.h>
  34. #include <linux/module.h>
  35. #include <linux/string.h>
  36. #include <linux/sched.h>
  37. #include <linux/sound.h>
  38. #include <linux/soundcard.h>
  39. #include <linux/pci.h>
  40. #include <linux/smp_lock.h>
  41. #include <linux/delay.h>
  42. #include <linux/slab.h>
  43. #include <asm/dma.h>
  44. #include <linux/init.h>
  45. #include <linux/poll.h>
  46. #include "rme96xx.h"
  48. #define NR_DEVICE 2
  50. static int devices = 1;
  51. MODULE_PARM(devices, "1-" __MODULE_STRING(NR_DEVICE) "i");
  52. MODULE_PARM_DESC(devices, "number of dsp devices allocated by the driver");
  55. MODULE_AUTHOR("Guenter Geiger, geiger@debian.org");
  56. MODULE_DESCRIPTION("RME9652/36 "Hammerfall" Driver");
  57. MODULE_LICENSE("GPL");
  60. #ifdef DEBUG
  61. #define DBG(x) printk("RME_DEBUG:");x
  62. #define COMM(x) printk("RME_COMM: " x "n");
  63. #else
  64. #define DBG(x) while (0) {}
  65. #define COMM(x)
  66. #endif
  68. /*-------------------------------------------------------------------------- 
  69.                         Preporcessor Macros and Definitions
  70.  --------------------------------------------------------------------------*/
  72. #define RME96xx_MAGIC 0x6473
  74. /* Registers-Space in offsets from base address with 16MByte size */
  76. #define RME96xx_IO_EXTENT     16l*1024l*1024l
  77. #define RME96xx_CHANNELS_PER_CARD 26
  79. /*                  Write - Register */
  81. /* 0,4,8,12,16,20,24,28 ... hardware init (erasing fifo-pointer intern) */
  82. #define RME96xx_num_of_init_regs   8
  84. #define RME96xx_init_buffer       (0/4)
  85. #define RME96xx_play_buffer       (32/4)  /* pointer to 26x64kBit RAM from mainboard */
  86. #define RME96xx_rec_buffer        (36/4)  /* pointer to 26x64kBit RAM from mainboard */
  87. #define RME96xx_control_register  (64/4)  /* exact meaning see below */
  88. #define RME96xx_irq_clear         (96/4)  /* irq acknowledge */
  89. #define RME96xx_time_code         (100/4) /* if used with alesis adat */
  90. #define RME96xx_thru_base         (128/4) /* 132...228 Thru for 26 channels */
  91. #define RME96xx_thru_channels     RME96xx_CHANNELS_PER_CARD
  93. /*                     Read Register */
  95. #define RME96xx_status_register    0     /* meaning see below */
  99. /* Status Register: */
  100. /* ------------------------------------------------------------------------ */
  101. #define RME96xx_IRQ          0x0000001 /* IRQ is High if not reset by RMExx_irq_clear */
  102. #define RME96xx_lock_2       0x0000002 /* ADAT 3-PLL: 1=locked, 0=unlocked */
  103. #define RME96xx_lock_1       0x0000004 /* ADAT 2-PLL: 1=locked, 0=unlocked */
  104. #define RME96xx_lock_0       0x0000008 /* ADAT 1-PLL: 1=locked, 0=unlocked */
  106. #define RME96xx_fs48         0x0000010 /* sample rate 0 ...44.1/88.2,  1 ... 48/96 Khz */
  107. #define RME96xx_wsel_rd      0x0000020 /* if Word-Clock is used and valid then 1 */
  108. #define RME96xx_buf_pos1     0x0000040 /* Bit 6..15 : Position of buffer-pointer in 64Bytes-blocks */
  109. #define RME96xx_buf_pos2     0x0000080 /* resolution +/- 1 64Byte/block (since 64Bytes bursts) */
  110.  
  111. #define RME96xx_buf_pos3     0x0000100 /* 10 bits = 1024 values */
  112. #define RME96xx_buf_pos4     0x0000200 /* if we mask off the first 6 bits, we can take the status */
  113. #define RME96xx_buf_pos5     0x0000400 /* register as sample counter in the hardware buffer */
  114. #define RME96xx_buf_pos6     0x0000800 
  116. #define RME96xx_buf_pos7     0x0001000 
  117. #define RME96xx_buf_pos8     0x0002000 
  118. #define RME96xx_buf_pos9     0x0004000
  119. #define RME96xx_buf_pos10    0x0008000 
  121. #define RME96xx_sync_2       0x0010000 /* if ADAT-IN3 synced to system clock */
  122. #define RME96xx_sync_1       0x0020000 /* if ADAT-IN2 synced to system clock */
  123. #define RME96xx_sync_0       0x0040000 /* if ADAT-IN1 synced to system clock */
  124. #define RME96xx_DS_rd        0x0080000 /* 1=Double Speed, 0=Normal Speed */
  126. #define RME96xx_tc_busy      0x0100000 /* 1=time-code copy in progress (960ms) */
  127. #define RME96xx_tc_out       0x0200000 /* time-code out bit */
  128. #define RME96xx_F_0          0x0400000 /*  000=64kHz, 100=88.2kHz, 011=96kHz  */
  129. #define RME96xx_F_1          0x0800000 /*  111=32kHz, 110=44.1kHz, 101=48kHz, */
  131. #define RME96xx_F_2          0x1000000 /*  od external Crystal Chip if ERF=1*/
  132. #define RME96xx_ERF          0x2000000 /* Error-Flag of SDPIF Receiver (1=No Lock)*/
  133. #define RME96xx_buffer_id    0x4000000 /* toggles by each interrupt on rec/play */
  134. #define RME96xx_tc_valid     0x8000000 /* 1 = a signal is detected on time-code input */
  136. /* Status Register Fields */
  138. #define RME96xx_lock            (RME96xx_lock_0|RME96xx_lock_1|RME96xx_lock_2)
  139. #define RME96xx_buf_pos          0x000FFC0 
  140. #define RME96xx_sync            (RME96xx_sync_0|RME96xx_sync_1|RME96xx_sync_2)
  141. #define RME96xx_F               (RME96xx_F_0|RME96xx_F_1|RME96xx_F_2)
  145. /* Control-Register: */     
  146. /*--------------------------------------------------------------------------------*/
  148. #define RME96xx_start_bit    0x0001    /* start record/play */
  149. #define RME96xx_latency0    0x0002    /* Bit 0 -  Buffer size or latency */
  150. #define RME96xx_latency1    0x0004    /* Bit 1 - Buffer size or latency */
  151. #define RME96xx_latency2    0x0008    /* Bit 2 - Buffer size or latency */
  153. #define RME96xx_Master    0x0010   /* Clock Mode Master=1,Slave/Auto=0 */
  154. #define RME96xx_IE    0x0020   /* Interupt Enable */
  155. #define RME96xx_freq    0x0040   /* samplerate 0=44.1/88.2, 1=48/96 kHz*/
  158. #define RME96xx_DS                 0x0100   /* Doule Speed 0=44.1/48, 1=88.2/96 Khz */
  159. #define RME96xx_PRO    0x0200    /* spdif 0=consumer, 1=professional Mode*/
  160. #define RME96xx_EMP    0x0400    /* spdif Emphasis 0=None, 1=ON */
  161. #define RME96xx_Dolby    0x0800    /* spdif Non-audio bit 1=set, 0=unset */
  163. #define RME96xx_opt_out            0x1000  /* Use 1st optical OUT as SPDIF: 1=yes,0=no */
  164. #define RME96xx_wsel               0x2000  /* use Wordclock as sync (overwrites master)*/
  165. #define RME96xx_inp_0              0x4000  /* SPDIF-IN: 00=optical (ADAT1),     */
  166. #define RME96xx_inp_1              0x8000  /* 01=koaxial (Cinch), 10=Internal CDROM*/
  168. #define RME96xx_SyncRef0           0x10000  /* preferred sync-source in autosync */
  169. #define RME96xx_SyncRef1           0x20000  /* 00=ADAT1,01=ADAT2,10=ADAT3,11=SPDIF */
  172. #define RME96xx_ctrl_init            (RME96xx_latency0 |
  173.                                      RME96xx_Master |
  174.                                      RME96xx_inp_1)
  175.                               
  178. /* Control register fields and shortcuts */
  180. #define RME96xx_latency (RME96xx_latency0|RME96xx_latency1|RME96xx_latency2)
  181. #define RME96xx_inp         (RME96xx_inp_0|RME96xx_inp_1)
  182. #define RME96xx_SyncRef    (RME96xx_SyncRef0|RME96xx_SyncRef1)
  183. /* latency = 512Bytes * 2^n, where n is made from Bit3 ... Bit0 */
  185. #define RME96xx_SET_LATENCY(x)   (((x)&0x7)<<1)
  186. #define RME96xx_GET_LATENCY(x)   (((x)>>1)&0x7)
  187. #define RME96xx_SET_inp(x) (((x)&0x3)<<14)
  188. #define RME96xx_GET_inp(x)   (((x)>>14)&0x3)
  189. #define RME96xx_SET_SyncRef(x) (((x)&0x3)<<17)
  190. #define RME96xx_GET_SyncRef(x)   (((x)>>17)&0x3)
  193. /* buffer sizes */
  194. #define RME96xx_BYTES_PER_SAMPLE  4 /* sizeof(u32) */
  195. #define RME_16K 16*1024
  197. #define RME96xx_DMA_MAX_SAMPLES  (RME_16K)
  198. #define RME96xx_DMA_MAX_SIZE     (RME_16K * RME96xx_BYTES_PER_SAMPLE)
  199. #define RME96xx_DMA_MAX_SIZE_ALL (RME96xx_DMA_MAX_SIZE * RME96xx_CHANNELS_PER_CARD)
  201. #define RME96xx_NUM_OF_FRAGMENTS     2
  202. #define RME96xx_FRAGMENT_MAX_SIZE    (RME96xx_DMA_MAX_SIZE/2)
  203. #define RME96xx_FRAGMENT_MAX_SAMPLES (RME96xx_DMA_MAX_SAMPLES/2)
  204. #define RME96xx_MAX_LATENCY       7   /* 16k samples */
  207. #define RME96xx_MAX_DEVS 4 /* we provide some OSS stereodevs */
  209. #define RME_MESS "rme96xx:"
  210. /*------------------------------------------------------------------------ 
  211.                   Types, struct and function declarations 
  212.  ------------------------------------------------------------------------*/
  215. /* --------------------------------------------------------------------- */
  217. static const char invalid_magic[] = KERN_CRIT RME_MESS" invalid magic valuen";
  219. #define VALIDATE_STATE(s)                         
  220. ({                                                
  221. if (!(s) || (s)->magic != RME96xx_MAGIC) { 
  222. printk(invalid_magic);            
  223. return -ENXIO;                    
  224. }                                         
  225. })
  227. /* --------------------------------------------------------------------- */
  230. static struct file_operations rme96xx_audio_fops;
  231. static struct file_operations rme96xx_mixer_fops;
  232. static int numcards;
  234. typedef int32_t raw_sample_t;
  236. typedef struct _rme96xx_info {
  238. /* hardware settings */
  239. int magic;
  240. struct pci_dev * pcidev; /* pci_dev structure */
  241. unsigned long *iobase;
  242. unsigned int irq;
  244. /* list of rme96xx devices */
  245. struct list_head devs;
  247. spinlock_t lock;
  249. u32 *recbuf;             /* memory for rec buffer */
  250. u32 *playbuf;            /* memory for play buffer */
  252. u32 control_register;
  254. u32 thru_bits; /* thru 1=on, 0=off channel 1=Bit1... channel 26= Bit26 */
  256. int open_count;
  259. int rate;
  260. int latency;
  261. unsigned int fragsize;
  262. int started;
  264. int hwptr; /* can be negativ because of pci burst offset  */
  265. unsigned int hwbufid;  /* set by interrupt, buffer which is written/read now */
  267. struct dmabuf {
  269. unsigned int format;
  270. int formatshift;
  271. int inchannels;       /* number of channels for device */
  272. int outchannels;       /* number of channels for device */
  273. int mono; /* if true, we play mono on 2 channels */
  274. int inoffset; /* which channel is considered the first one */
  275.           int outoffset;
  277. /* state */
  278. int opened;               /* open() made */
  279. int started;              /* first write/read */
  280. int mmapped;              /* mmap */
  281. int open_mode;
  283. struct _rme96xx_info *s;  
  285. /* pointer to read/write position in buffer */
  286. unsigned readptr;          
  287. unsigned writeptr;          
  289. unsigned error; /* over/underruns cleared on sync again */
  291. /* waiting and locking */
  292. wait_queue_head_t wait;
  293. struct semaphore  open_sem;
  294. wait_queue_head_t open_wait;
  296. } dma[RME96xx_MAX_DEVS]; 
  298. int dspnum[RME96xx_MAX_DEVS];  /* register with sound subsystem */ 
  299. int mixer;  /* register with sound subsystem */ 
  300. } rme96xx_info;
  303. /* fiddling with the card (first level hardware control) */
  305. inline void rme96xx_set_ctrl(rme96xx_info* s,int mask)
  306. {
  308. s->control_register|=mask;
  309. writel(s->control_register,s->iobase + RME96xx_control_register);
  311. }
  313. inline void rme96xx_unset_ctrl(rme96xx_info* s,int mask)
  314. {
  316. s->control_register&=(~mask);
  317. writel(s->control_register,s->iobase + RME96xx_control_register);
  319. }
  323. /* the hwbuf in the status register seems to have some jitter, to get rid of
  324.    it, we first only let the numbers grow, to be on the secure side we 
  325.    subtract a certain amount RME96xx_BURSTBYTES from the resulting number */
  327. /* the function returns the hardware pointer in bytes */
  328. #define RME96xx_BURSTBYTES -64  /* bytes by which hwptr could be off */
  330. inline int rme96xx_gethwptr(rme96xx_info* s,int exact)
  331. {
  332. long flags;
  333. if (exact) {
  334. unsigned int hwp;
  335. /* the hwptr seems to be rather unreliable :(, so we don't use it */
  336. spin_lock_irqsave(&s->lock,flags);
  338. hwp  = readl(s->iobase + RME96xx_status_register) & 0xffc0;
  339. s->hwptr = (hwp < s->hwptr) ? s->hwptr : hwp;
  340. // s->hwptr = hwp;
  342. spin_unlock_irqrestore(&s->lock,flags);
  343. return (s->hwptr+RME96xx_BURSTBYTES) & ((s->fragsize<<1)-1);
  344. }
  345. return (s->hwbufid ? s->fragsize : 0);
  346. }
  348. inline void rme96xx_setlatency(rme96xx_info* s,int l)
  349. {
  350. s->latency = l;
  351. s->fragsize = 1<<(8+l);
  352. rme96xx_unset_ctrl(s,RME96xx_latency);
  353. rme96xx_set_ctrl(s,RME96xx_SET_LATENCY(l));
  354. }
  357. static void rme96xx_clearbufs(struct dmabuf* dma)
  358. {
  359. int i,j;
  360. unsigned long flags;
  362. /* clear dmabufs */
  363. for(i=0;i<devices;i++) {
  364. for (j=0;j<dma->outchannels + dma->mono;j++)
  365. memset(&dma->s->playbuf[(dma->outoffset + j)*RME96xx_DMA_MAX_SAMPLES], 
  366.        0, RME96xx_DMA_MAX_SIZE);
  367. }
  368. spin_lock_irqsave(&dma->s->lock,flags);
  369. dma->writeptr = 0;
  370. dma->readptr = 0;
  371. spin_unlock_irqrestore(&dma->s->lock,flags);
  372. }
  374. static int rme96xx_startcard(rme96xx_info *s,int stop)
  375. {
  376. int i;
  377. long flags;
  379. COMM       ("startcard");
  380. if(s->control_register & RME96xx_IE){
  381. /* disable interrupt first */
  383. rme96xx_unset_ctrl( s,RME96xx_start_bit );
  384. udelay(10);
  385. rme96xx_unset_ctrl( s,RME96xx_IE);
  386. spin_lock_irqsave(&s->lock,flags); /* timing is critical */
  387. s->started = 0;
  388. spin_unlock_irqrestore(&s->lock,flags);
  389. if (stop) {
  390.      COMM("Sound card stopped");
  391.      return 1;
  392. }
  393. }
  394. COMM       ("interupt disabled");
  395. /* first initialize all pointers on card */
  396. for(i=0;i<RME96xx_num_of_init_regs;i++){
  397. writel(0,s->iobase + i);
  398. udelay(10); /* ?? */
  399. }
  400. COMM       ("regs cleaned");
  402. spin_lock_irqsave(&s->lock,flags); /* timing is critical */
  403. udelay(10);
  404. s->started = 1;
  405. s->hwptr = 0;
  406. spin_unlock_irqrestore(&s->lock,flags);
  408. rme96xx_set_ctrl( s, RME96xx_IE | RME96xx_start_bit);
  411. COMM("Sound card started");
  412.   
  413. return 1;
  414. }
  417. inline int rme96xx_getospace(struct dmabuf * dma, unsigned int hwp)
  418. {
  419. int cnt;
  420. int  swptr;
  421. unsigned long flags;
  423. spin_lock_irqsave(&dma->s->lock,flags); 
  424. swptr = dma->writeptr;
  425. cnt = (hwp - swptr);
  427. if (cnt < 0) {
  428.      cnt = ((dma->s->fragsize<<1) - swptr);
  429. }
  430. spin_unlock_irqrestore(&dma->s->lock,flags);
  431. return cnt;
  432. }
  434. inline int rme96xx_getispace(struct dmabuf * dma, unsigned int hwp)
  435. {
  436. int cnt;
  437. int  swptr;
  438. unsigned long flags;
  440. spin_lock_irqsave(&dma->s->lock,flags); 
  441. swptr = dma->readptr;
  442. cnt = (hwp - swptr);
  443.  
  444. if (cnt < 0) {
  445. cnt = ((dma->s->fragsize<<1) - swptr);
  446. }
  447. spin_unlock_irqrestore(&dma->s->lock,flags);
  448. return cnt;
  449. }
  452. inline int rme96xx_copyfromuser(struct dmabuf* dma,const char* buffer,int count,int hop)
  453. {
  454. int swptr = dma->writeptr;
  455. switch (dma->format) {
  456. case AFMT_S32_BLOCKED:
  457. {
  458.      char* buf = (char*)buffer;
  459.      int cnt = count/dma->outchannels;
  460.      int i;
  461.      for (i=0;i < dma->outchannels;i++) {
  462.   char* hwbuf =(char*) &dma->s->playbuf[(dma->outoffset + i)*RME96xx_DMA_MAX_SAMPLES];
  463.   hwbuf+=swptr;
  465.   if (copy_from_user(hwbuf,buf, cnt))
  466.        return -1;
  467.   buf+=hop;
  468.      }
  469.      swptr+=cnt;
  470.      break;
  471. }
  472. case AFMT_S16_LE:
  473. {
  474.      int i,j;
  475.      int cnt = count/dma->outchannels;
  476.      for (i=0;i < dma->outchannels + dma->mono;i++) {
  477.      short* sbuf = (short*)buffer + i*(!dma->mono);
  478.      short* hwbuf =(short*) &dma->s->playbuf[(dma->outoffset + i)*RME96xx_DMA_MAX_SAMPLES];      
  479.      hwbuf+=(swptr>>1);
  480.      for (j=0;j<(cnt>>1);j++) {
  481.      hwbuf++; /* skip the low 16 bits */
  482.      __get_user(*hwbuf++,sbuf++);
  483.      sbuf+=(dma->outchannels-1);
  484.      }
  485.      }
  486.      swptr += (cnt<<1);
  487.      break;
  488. }
  489. default:
  490.      printk(RME_MESS" unsupported formatn");
  491.      return -1;
  492. } /* switch */
  494. swptr&=((dma->s->fragsize<<1) -1);
  495. dma->writeptr = swptr;
  497. return 0;
  498. }
  500. /* The count argument is the number of bytes */
  501. inline int rme96xx_copytouser(struct dmabuf* dma,const char* buffer,int count,int hop)
  502. {
  503. int swptr = dma->readptr;
  504. switch (dma->format) {
  505. case AFMT_S32_BLOCKED:
  506. {
  507.      char* buf = (char*)buffer;
  508.      int cnt = count/dma->inchannels;
  509.      int i;
  511.      for (i=0;i < dma->inchannels;i++) {
  512.   char* hwbuf =(char*) &dma->s->recbuf[(dma->inoffset + i)*RME96xx_DMA_MAX_SAMPLES];
  513.   hwbuf+=swptr;
  515.   if (copy_to_user(buf,hwbuf,cnt))
  516.        return -1;
  517.   buf+=hop;
  518.      }
  519.      swptr+=cnt;
  520.      break;
  521. }
  522. case AFMT_S16_LE:
  523. {
  524.      int i,j;
  525.      int cnt = count/dma->inchannels;
  526.      for (i=0;i < dma->inchannels;i++) {
  527.   short* sbuf = (short*)buffer + i;
  528.   short* hwbuf =(short*) &dma->s->recbuf[(dma->inoffset + i)*RME96xx_DMA_MAX_SAMPLES];      
  529.   hwbuf+=(swptr>>1);
  530.   for (j=0;j<(cnt>>1);j++) {
  531.        hwbuf++;
  532.        __put_user(*hwbuf++,sbuf++);
  533.        sbuf+=(dma->inchannels-1);
  534.   }
  535.      }
  536.      swptr += (cnt<<1);
  537.      break;
  538. }
  539. default:
  540.      printk(RME_MESS" unsupported formatn");
  541.      return -1;
  542. } /* switch */
  544. swptr&=((dma->s->fragsize<<1) -1);
  545. dma->readptr = swptr;
  546. return 0;
  547. }
  550. static void rme96xx_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  551. {
  552. int i;
  553. rme96xx_info *s = (rme96xx_info *)dev_id;
  554. struct dmabuf *db;
  555. u32 status;
  556. unsigned long flags;
  558. status = readl(s->iobase + RME96xx_status_register);
  559. if (!(status & RME96xx_IRQ)) {
  560. return;
  561. }
  563. spin_lock_irqsave(&s->lock,flags);
  564. writel(0,s->iobase + RME96xx_irq_clear);
  566. s->hwbufid = (status & RME96xx_buffer_id)>>26;
  567. if ((status & 0xffc0) <= 256) s->hwptr = 0; 
  568. for(i=0;i<devices;i++)
  569. {
  570. db = &(s->dma[i]);
  571. if(db->started > 0)
  572. wake_up(&(db->wait));
  573. }  
  574. spin_unlock_irqrestore(&s->lock,flags);
  575. }
  579. /*---------------------------------------------------------------------------- 
  580.  PCI detection and module initialization stuff 
  581.  ----------------------------------------------------------------------------*/
  583. void* busmaster_malloc(int size) {
  584.      int pg; /* 2 s exponent of memory size */
  585.         char *buf;
  587.         DBG(printk("kernel malloc pages ..n"));
  588.         
  589.         for (pg = 0; PAGE_SIZE * (1 << pg) < size; pg++);
  591.         buf = (char *) __get_free_pages(GFP_KERNEL | GFP_DMA, pg);
  593.         if (buf) {
  594.                 struct page* page, *last_page;
  596.                 page = virt_to_page(buf);
  597.                 last_page = virt_to_page(buf + (1 << pg));
  598.                 DBG(printk("setting reserved bitn"));
  599.                 while (page < last_page) {
  600. SetPageReserved(page);
  601.                         page++;
  602.                 }
  603. return buf;
  604.         }
  605. DBG(printk("allocated %ld",(long)buf));
  606. return NULL;
  607. }
  609. void busmaster_free(void* ptr,int size) {
  610.         int pg;
  611. struct page* page, *last_page;
  613.         if (ptr == NULL)
  614.                 return;
  616.         for (pg = 0; PAGE_SIZE * (1 << pg) < size; pg++);
  618.         page = virt_to_page(ptr);
  619.         last_page = page + (1 << pg);
  620.         while (page < last_page) {
  621. ClearPageReserved(page);
  622. page++;
  623. }
  624. DBG(printk("freeing pagesn"));
  625.         free_pages((unsigned long) ptr, pg);
  626. DBG(printk("donen"));
  627. }
  629. /* initialize those parts of the info structure which are not pci detectable resources */
  631. static int rme96xx_dmabuf_init(rme96xx_info * s,struct dmabuf* dma,int ioffset,int ooffset) {
  633. init_MUTEX(&dma->open_sem);
  634. init_waitqueue_head(&dma->open_wait);
  635. init_waitqueue_head(&dma->wait);
  636. dma->s = s; 
  637. dma->error = 0;
  639. dma->format = AFMT_S32_BLOCKED;
  640. dma->formatshift = 0;
  641. dma->inchannels = dma->outchannels = 1;
  642. dma->inoffset = ioffset;
  643. dma->outoffset = ooffset;
  645. dma->opened=0;
  646. dma->started=0;
  647. dma->mmapped=0;
  648. dma->open_mode=0;
  649. dma->mono=0;
  651. rme96xx_clearbufs(dma);
  652. return 0;
  653. }
  656. int rme96xx_init(rme96xx_info* s)
  657. {
  658. int i;
  659. DBG(printk(__FUNCTION__"n"));
  660. numcards++;
  662. s->magic = RME96xx_MAGIC; 
  664. spin_lock_init(&s->lock);
  666. COMM            ("setup busmaster memory")
  667. s->recbuf = busmaster_malloc(RME96xx_DMA_MAX_SIZE_ALL);
  668. s->playbuf = busmaster_malloc(RME96xx_DMA_MAX_SIZE_ALL);
  670. if (!s->recbuf || !s->playbuf) {
  671. printk(KERN_ERR RME_MESS" Unable to allocate busmaster memoryn");
  672. return -ENODEV;
  673. }
  675. COMM            ("setting rec and playbuffers")
  677. writel((u32) virt_to_bus(s->recbuf),s->iobase + RME96xx_rec_buffer);
  678.    writel((u32) virt_to_bus(s->playbuf),s->iobase + RME96xx_play_buffer);
  680. COMM             ("initializing control register")
  681. rme96xx_unset_ctrl(s,0xffffffff);
  682. rme96xx_set_ctrl(s,RME96xx_ctrl_init);
  685. COMM              ("setup devices")
  686. for (i=0;i < devices;i++) {
  687. struct dmabuf * dma = &s->dma[i];
  688. rme96xx_dmabuf_init(s,dma,2*i,2*i);
  689. }
  691. s->started = 0;
  692. rme96xx_setlatency(s,7);
  694. printk(KERN_INFO RME_MESS" card %d initializedn",numcards); 
  695. return 0;
  696. }
  699. /* open uses this to figure out which device was opened .. this seems to be 
  700.    unnecessary complex */
  702. static LIST_HEAD(devs);
  704. static int __devinit rme96xx_probe(struct pci_dev *pcidev, const struct pci_device_id *pciid)
  705. {
  706. int i;
  707. rme96xx_info *s;
  709. DBG(printk(__FUNCTION__"n"));
  711. if (pcidev->irq == 0) 
  712. return -1;
  713. if (!pci_dma_supported(pcidev, 0xffffffff)) {
  714. printk(KERN_WARNING RME_MESS" architecture does not support 32bit PCI busmaster DMAn");
  715. return -1;
  716. }
  717. if (!(s = kmalloc(sizeof(rme96xx_info), GFP_KERNEL))) {
  718. printk(KERN_WARNING RME_MESS" out of memoryn");
  719. return -1;
  720. }
  721. memset(s, 0, sizeof(rme96xx_info));
  723. s->pcidev = pcidev;
  724. s->iobase = ioremap(pci_resource_start(pcidev, 0),RME96xx_IO_EXTENT);
  725. s->irq = pcidev->irq;
  727.         DBG(printk("remapped iobase: %lx irq %dn",(long)s->iobase,s->irq));
  729. if (pci_enable_device(pcidev))
  730. goto err_irq;
  731. if (request_irq(s->irq, rme96xx_interrupt, SA_SHIRQ, "es1370", s)) {
  732. printk(KERN_ERR RME_MESS" irq %u in usen", s->irq);
  733. goto err_irq;
  734. }
  736. /* initialize the card */
  738. i = 0;
  739. if (rme96xx_init(s) < 0) {
  740. printk(KERN_ERR RME_MESS" initialization failedn");
  741. goto err_devices;
  742. }
  743. for (i=0;i<devices;i++) {
  744. if ((s->dspnum[i] = register_sound_dsp(&rme96xx_audio_fops, -1)) < 0)
  745. goto err_devices;
  746. }
  748. if ((s->mixer = register_sound_mixer(&rme96xx_mixer_fops, -1)) < 0)
  749. goto err_devices;
  751. pci_set_drvdata(pcidev, s);
  752. pcidev->dma_mask = 0xffffffff; /* ????? */
  753. /* put it into driver list */
  754. list_add_tail(&s->devs, &devs);
  756. DBG(printk("initialization successfuln"));
  757. return 0;
  759. /* error handler */
  760.  err_devices:
  761. while (i--) 
  762. unregister_sound_dsp(s->dspnum[i]);
  763. free_irq(s->irq,s);
  764.  err_irq:
  765. kfree(s);
  766. return -1;
  767. }
  770. static void __devinit rme96xx_remove(struct pci_dev *dev)
  771. {
  772. int i;
  773. rme96xx_info *s = pci_get_drvdata(dev);
  775. if (!s) {
  776. printk(KERN_ERR"device structure not validn");
  777. return ;
  778. }
  780. if (s->started) rme96xx_startcard(s,0);
  782. i = devices;
  783. while (i) {
  784. i--;
  785. unregister_sound_dsp(s->dspnum[i]);
  786. }
  788. unregister_sound_mixer(s->mixer);
  789. /* synchronize_irq(); This call got lost somehow ? */
  790.         free_irq(s->irq,s);
  791. busmaster_free(s->recbuf,RME96xx_DMA_MAX_SIZE_ALL);
  792. busmaster_free(s->playbuf,RME96xx_DMA_MAX_SIZE_ALL);
  793. kfree(s);
  794. pci_set_drvdata(dev, NULL);
  795. }
  798. #ifndef PCI_VENDOR_ID_RME 
  799. #define PCI_VENDOR_ID_RME 0x10ee
  800. #endif
  801. #ifndef PCI_DEVICE_ID_RME9652
  802. #define PCI_DEVICE_ID_RME9652 0x3fc4
  803. #endif
  804. #ifndef PCI_ANY_ID
  805. #define PCI_ANY_ID 0
  806. #endif
  808. static struct pci_device_id id_table[] __devinitdata = {
  809. { PCI_VENDOR_ID_RME, PCI_DEVICE_ID_RME9652, PCI_ANY_ID, PCI_ANY_ID, 0, 0 },
  810. { 0, }
  811. };
  813. MODULE_DEVICE_TABLE(pci, id_table);
  815. static struct pci_driver rme96xx_driver = {
  816. name: "rme96xx",
  817. id_table: id_table,
  818. probe: rme96xx_probe,
  819. remove: rme96xx_remove
  820. };
  822. static int __init init_rme96xx(void)
  823. {
  824.   
  825. if (!pci_present())   /* No PCI bus in this machine! */
  826. return -ENODEV;
  827. printk(KERN_INFO RME_MESS" version "RMEVERSION" time " __TIME__ " " __DATE__ "n");
  828. printk(KERN_INFO RME_MESS" reserving %d dsp device(s)n",devices);
  829.         numcards = 0;
  830. return pci_module_init(&rme96xx_driver);
  831. }
  833. static void __exit cleanup_rme96xx(void)
  834. {
  835. printk(KERN_INFO RME_MESS" unloadingn");
  836. pci_unregister_driver(&rme96xx_driver);
  837. }
  839. module_init(init_rme96xx);
  840. module_exit(cleanup_rme96xx);
  846. /*-------------------------------------------------------------------------- 
  847.    Implementation of file operations 
  848. ---------------------------------------------------------------------------*/
  850. #define RME96xx_FMT (AFMT_S16_LE|AFMT_U8|AFMT_S32_BLOCKED)
  853. static int rme96xx_ioctl(struct inode *in, struct file *file, 
  854. unsigned int cmd, unsigned long arg)
  855. {
  858. struct dmabuf * dma = (struct dmabuf *)file->private_data; 
  859. rme96xx_info *s = dma->s;
  860. unsigned long flags;
  861.         audio_buf_info abinfo;
  862.         count_info cinfo;
  863. int count;
  864. int val = 0;
  866. VALIDATE_STATE(s);
  868. DBG(printk("ioctl %udn",cmd));
  870. switch (cmd) {
  871. case OSS_GETVERSION:
  872. return put_user(SOUND_VERSION, (int *)arg);
  874. case SNDCTL_DSP_SYNC:
  875. #if 0
  876. if (file->f_mode & FMODE_WRITE)
  877. return drain_dac2(s, 0/*file->f_flags & O_NONBLOCK*/);
  878. #endif
  879. return 0;
  881. case SNDCTL_DSP_SETDUPLEX:
  882. return 0;
  884. case SNDCTL_DSP_GETCAPS:
  885. return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, (int *)arg);
  887.         case SNDCTL_DSP_RESET:
  888. // rme96xx_clearbufs(dma);
  889. return 0;
  891.         case SNDCTL_DSP_SPEED:
  892.                 if (get_user(val, (int *)arg))
  893. return -EFAULT;
  894. if (val >= 0) {
  895. /* generally it's not a problem if we change the speed 
  896. if (dma->open_mode & (~file->f_mode) & (FMODE_READ|FMODE_WRITE))
  897. return -EINVAL;
  898. */
  899. spin_lock_irqsave(&s->lock, flags);
  901. switch (val) {
  902. case 44100:
  903. case 88200:
  904. rme96xx_unset_ctrl(s,RME96xx_freq);
  905. break;
  906. case 48000: 
  907. case 96000: 
  908. rme96xx_set_ctrl(s,RME96xx_freq);
  909. break;
  910. default:
  911. rme96xx_unset_ctrl(s,RME96xx_freq);
  912. val = 44100;
  913. }
  914. if (val > 50000)
  915. rme96xx_set_ctrl(s,RME96xx_DS);
  916. else
  917. rme96xx_unset_ctrl(s,RME96xx_DS);
  918. s->rate = val;
  919. spin_unlock_irqrestore(&s->lock, flags);
  920. }
  921. DBG(printk("speed set to %dn",val));
  922. return put_user(val, (int *)arg);
  924.         case SNDCTL_DSP_STEREO: /* this plays a mono file on two channels */
  925.                 if (get_user(val, (int *)arg))
  926. return -EFAULT;
  928. if (!val) {
  929. DBG(printk("setting to monon")); 
  930. dma->mono=1; 
  931. dma->inchannels = 1;
  932. dma->outchannels = 1;
  933. }
  934. else {
  935. DBG(printk("setting to stereon")); 
  936. dma->mono = 0;
  937. dma->inchannels = 2;
  938. dma->outchannels = 2;
  939. }
  940. return 0;
  941.         case SNDCTL_DSP_CHANNELS:
  942. /* remember to check for resonable offset/channel pairs here */
  943.                 if (get_user(val, (int *)arg))
  944. return -EFAULT;
  946. if (file->f_mode & FMODE_WRITE) { 
  947. if (val > 0 && (dma->outoffset + val) <= RME96xx_CHANNELS_PER_CARD) 
  948. dma->outchannels = val;
  949. else
  950. dma->outchannels = val = 2;
  951. DBG(printk("setting to outchannels %dn",val)); 
  952. }
  953. if (file->f_mode & FMODE_READ) {
  954. if (val > 0 && (dma->inoffset + val) <= RME96xx_CHANNELS_PER_CARD) 
  955. dma->inchannels = val;
  956. else
  957. dma->inchannels = val = 2;
  958. DBG(printk("setting to inchannels %dn",val)); 
  959. }
  961. dma->mono=0;
  963. return put_user(val, (int *)arg);
  965. case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  966.                 return put_user(RME96xx_FMT, (int *)arg);
  968. case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  969. DBG(printk("setting to format %xn",val)); 
  970. if (get_user(val, (int *)arg))
  971. return -EFAULT;
  972. if (val != AFMT_QUERY) {
  973. if (val & RME96xx_FMT)
  974. dma->format = val;
  975. switch (dma->format) {
  976. case AFMT_S16_LE:
  977. dma->formatshift=1;
  978. break;
  979. case AFMT_S32_BLOCKED:
  980. dma->formatshift=0;
  981. break;
  982. }
  983. }
  984. return put_user(dma->format, (int *)arg);
  986. case SNDCTL_DSP_POST:
  987.                 return 0;
  989.         case SNDCTL_DSP_GETTRIGGER:
  990. val = 0;
  991. #if 0
  992. if (file->f_mode & FMODE_READ && s->ctrl & CTRL_ADC_EN) 
  993. val |= PCM_ENABLE_INPUT;
  994. if (file->f_mode & FMODE_WRITE && s->ctrl & CTRL_DAC2_EN) 
  995. val |= PCM_ENABLE_OUTPUT;
  996. #endif
  997. return put_user(val, (int *)arg);
  999. case SNDCTL_DSP_SETTRIGGER:
  1000. if (get_user(val, (int *)arg))
  1001. return -EFAULT;
  1002. #if 0
  1003. if (file->f_mode & FMODE_READ) {
  1004. if (val & PCM_ENABLE_INPUT) {
  1005. if (!s->dma_adc.ready && (ret = prog_dmabuf_adc(s)))
  1006. return ret;
  1007. start_adc(s);
  1008. } else
  1009. stop_adc(s);
  1010. }
  1011. if (file->f_mode & FMODE_WRITE) {
  1012. if (val & PCM_ENABLE_OUTPUT) {
  1013. if (!s->dma_dac2.ready && (ret = prog_dmabuf_dac2(s)))
  1014. return ret;
  1015. start_dac2(s);
  1016. } else
  1017. stop_dac2(s);
  1018. }
  1019. #endif
  1020. return 0;
  1022. case SNDCTL_DSP_GETOSPACE:
  1023. if (!(file->f_mode & FMODE_WRITE))
  1024. return -EINVAL;
  1026. val = rme96xx_gethwptr(dma->s,0);
  1029. count = rme96xx_getospace(dma,val);
  1030. if (!s->started) count = s->fragsize*2;
  1031. abinfo.fragsize =(s->fragsize*dma->outchannels)>>dma->formatshift;
  1032.                 abinfo.bytes = (count*dma->outchannels)>>dma->formatshift;
  1033.                 abinfo.fragstotal = 2;
  1034.                 abinfo.fragments = (count > s->fragsize); 
  1036. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1038. case SNDCTL_DSP_GETISPACE:
  1039. if (!(file->f_mode & FMODE_READ))
  1040. return -EINVAL;
  1042. val = rme96xx_gethwptr(dma->s,0);
  1044. count = rme96xx_getispace(dma,val);
  1046. abinfo.fragsize = (s->fragsize*dma->inchannels)>>dma->formatshift;
  1047.                 abinfo.bytes = (count*dma->inchannels)>>dma->formatshift;;
  1048.                 abinfo.fragstotal = 2;
  1049.                 abinfo.fragments = count > s->fragsize; 
  1050. return copy_to_user((void *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1052.         case SNDCTL_DSP_NONBLOCK:
  1053.                 file->f_flags |= O_NONBLOCK;
  1054.                 return 0;
  1056.         case SNDCTL_DSP_GETODELAY: /* What shold this exactly do ? , 
  1057.       ATM it is just abinfo.bytes */
  1058. if (!(file->f_mode & FMODE_WRITE))
  1059. return -EINVAL;
  1061. val = rme96xx_gethwptr(dma->s,0);
  1062. count = val - dma->readptr;
  1063. if (count < 0)
  1064. count += s->fragsize<<1;
  1066. return put_user(count, (int *)arg);
  1069. /* check out how to use mmaped mode (can only be blocked !!!) */
  1070.         case SNDCTL_DSP_GETIPTR:
  1071. if (!(file->f_mode & FMODE_READ))
  1072. return -EINVAL;
  1073. val = rme96xx_gethwptr(dma->s,0);
  1074. spin_lock_irqsave(&s->lock,flags);
  1075.                 cinfo.bytes = s->fragsize<<1;;
  1076. count = val - dma->readptr;
  1077. if (count < 0)
  1078. count += s->fragsize<<1;
  1080.                 cinfo.blocks = (count > s->fragsize); 
  1081.                 cinfo.ptr = val;
  1082. if (dma->mmapped)
  1083. dma->readptr &= s->fragsize<<1;
  1084. spin_unlock_irqrestore(&s->lock,flags);
  1086.                 return copy_to_user((void *)arg, &cinfo, sizeof(cinfo));
  1088.         case SNDCTL_DSP_GETOPTR:
  1089. if (!(file->f_mode & FMODE_READ))
  1090. return -EINVAL;
  1091. val = rme96xx_gethwptr(dma->s,0);
  1092. spin_lock_irqsave(&s->lock,flags);
  1093.                 cinfo.bytes = s->fragsize<<1;;
  1094. count = val - dma->writeptr;
  1095. if (count < 0)
  1096. count += s->fragsize<<1;
  1098.                 cinfo.blocks = (count > s->fragsize); 
  1099.                 cinfo.ptr = val;
  1100. if (dma->mmapped)
  1101. dma->writeptr &= s->fragsize<<1;
  1102. spin_unlock_irqrestore(&s->lock,flags);
  1103.                 return copy_to_user((void *)arg, &cinfo, sizeof(cinfo));
  1104.         case SNDCTL_DSP_GETBLKSIZE:
  1105.      return put_user(s->fragsize, (int *)arg);
  1107.         case SNDCTL_DSP_SETFRAGMENT:
  1108.                 if (get_user(val, (int *)arg))
  1109. return -EFAULT;
  1110. val&=0xffff;
  1111. val -= 7;
  1112. if (val < 0) val = 0;
  1113. if (val > 7) val = 7;
  1114. rme96xx_setlatency(s,val);
  1115. return 0;
  1117.         case SNDCTL_DSP_SUBDIVIDE:
  1118. #if 0
  1119. if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
  1120.     (file->f_mode & FMODE_WRITE && s->dma_dac2.subdivision))
  1121. return -EINVAL;
  1122.                 if (get_user(val, (int *)arg))
  1123. return -EFAULT;
  1124. if (val != 1 && val != 2 && val != 4)
  1125. return -EINVAL;
  1126. if (file->f_mode & FMODE_READ)
  1127. s->dma_adc.subdivision = val;
  1128. if (file->f_mode & FMODE_WRITE)
  1129. s->dma_dac2.subdivision = val;
  1130. #endif
  1131. return 0;
  1133.         case SOUND_PCM_READ_RATE:
  1134. return put_user(s->rate, (int *)arg);
  1136.         case SOUND_PCM_READ_CHANNELS:
  1137. return put_user(dma->outchannels, (int *)arg);
  1139.         case SOUND_PCM_READ_BITS:
  1140. switch (dma->format) {
  1141. case AFMT_S32_BLOCKED:
  1142. val = 32;
  1143. break;
  1144. case AFMT_S16_LE:
  1145. val = 16;
  1146. break;
  1147. }
  1148. return put_user(val, (int *)arg);
  1150.         case SOUND_PCM_WRITE_FILTER:
  1151.         case SNDCTL_DSP_SETSYNCRO:
  1152.         case SOUND_PCM_READ_FILTER:
  1153.                 return -EINVAL;
  1155. }
  1158. return -ENODEV;
  1159. }
  1163. static int rme96xx_open(struct inode *in, struct file *f)
  1164. {
  1165. int minor = MINOR(in->i_rdev);
  1166. struct list_head *list;
  1167. int devnum = ((minor-3)/16) % devices; /* default = 0 */
  1168. rme96xx_info *s;
  1169. struct dmabuf* dma;
  1170. DECLARE_WAITQUEUE(wait, current); 
  1172. DBG(printk("device num %d openn",devnum));
  1174. /* ??? */
  1175. for (list = devs.next; ; list = list->next) {
  1176. if (list == &devs)
  1177. return -ENODEV;
  1178. s = list_entry(list, rme96xx_info, devs);
  1179. if (!((s->dspnum[devnum] ^ minor) & ~0xf)) 
  1180. break;
  1181. }
  1182.         VALIDATE_STATE(s);
  1183. /* ??? */
  1185. dma = &s->dma[devnum];
  1186. f->private_data = dma;
  1187. /* wait for device to become free */
  1188. down(&s->dma[devnum].open_sem);
  1189. while (dma->open_mode & f->f_mode) {
  1190. if (f->f_flags & O_NONBLOCK) {
  1191. up(&dma->open_sem);
  1192. return -EBUSY;
  1193. }
  1194. add_wait_queue(&dma->open_wait, &wait);
  1195. __set_current_state(TASK_INTERRUPTIBLE);
  1196. up(&dma->open_sem);
  1197. schedule();
  1198. remove_wait_queue(&dma->open_wait, &wait);
  1199. set_current_state(TASK_RUNNING);
  1200. if (signal_pending(current))
  1201. return -ERESTARTSYS;
  1202. down(&dma->open_sem);
  1203. }
  1205. COMM                ("hardware open")
  1207. if (!s->dma[devnum].opened) rme96xx_dmabuf_init(dma->s,dma,dma->inoffset,dma->outoffset);
  1209. s->dma[devnum].open_mode |= (f->f_mode & (FMODE_READ | FMODE_WRITE));
  1210. s->dma[devnum].opened = 1;
  1211. up(&s->dma[devnum].open_sem);
  1213. DBG(printk("device num %d open finishedn",devnum));
  1214. return 0;
  1215. }
  1217. static int rme96xx_release(struct inode *in, struct file *file)
  1218. {
  1219. struct dmabuf * dma = (struct dmabuf*) file->private_data;
  1220. int hwp;
  1221. DBG(printk(__FUNCTION__"n"));
  1223. COMM          ("draining")
  1224. if (dma->open_mode & FMODE_WRITE) {
  1225. #if 0 /* Why doesn't this work with some cards ?? */
  1226.      hwp = rme96xx_gethwptr(dma->s,0);
  1227.      while (rme96xx_getospace(dma,hwp)) {
  1228.   interruptible_sleep_on(&(dma->wait));
  1229.   hwp = rme96xx_gethwptr(dma->s,0);
  1230.      }
  1231. #endif
  1232.      rme96xx_clearbufs(dma);
  1233. }
  1235. dma->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
  1237. if (!(dma->open_mode & (FMODE_READ|FMODE_WRITE))) {
  1238.      dma->opened = 0;
  1239.      if (dma->s->started) rme96xx_startcard(dma->s,1);
  1240. }
  1242. wake_up(&dma->open_wait);
  1243. up(&dma->open_sem);
  1245. return 0;
  1246. }
  1249. static ssize_t rme96xx_write(struct file *file, const char *buffer, 
  1250.   size_t count, loff_t *ppos)
  1251. {
  1252. struct dmabuf *dma = (struct dmabuf *)file->private_data;
  1253. ssize_t ret = 0;
  1254. int cnt; /* number of bytes from "buffer" that will/can be used */
  1255. int hop = count/dma->outchannels;
  1256. int hwp;
  1257. int exact = (file->f_flags & O_NONBLOCK); 
  1260. if(dma == NULL || (dma->s) == NULL) 
  1261. return -ENXIO;
  1263. if (ppos != &file->f_pos)
  1264. return -ESPIPE;
  1266. if (dma->mmapped || !dma->opened)
  1267. return -ENXIO;
  1269. if (!access_ok(VERIFY_READ, buffer, count))
  1270. return -EFAULT;
  1272. if (! (dma->open_mode  & FMODE_WRITE))
  1273.                 return -ENXIO;
  1275. if (!dma->s->started) rme96xx_startcard(dma->s,exact);
  1276. hwp = rme96xx_gethwptr(dma->s,0);
  1278. if(!(dma->started)){  
  1279. COMM          ("first write")
  1281. dma->readptr = hwp;
  1282. dma->writeptr = hwp;
  1283. dma->started = 1;
  1284. COMM          ("first write done")
  1285. }
  1287.    while (count > 0) {
  1288. cnt = rme96xx_getospace(dma,hwp);
  1289. cnt>>=dma->formatshift;
  1290. cnt*=dma->outchannels;
  1291. if (cnt > count)
  1292. cnt = count;
  1294. if (cnt != 0) {
  1295.         if (rme96xx_copyfromuser(dma,buffer,cnt,hop))
  1296. return ret ? ret : -EFAULT;
  1297. count -= cnt;
  1298. buffer += cnt;
  1299. ret += cnt;
  1300. if (count == 0) return ret;
  1301. }
  1302. if (file->f_flags & O_NONBLOCK)
  1303. return ret ? ret : -EAGAIN;
  1305. if ((hwp - dma->writeptr) <= 0) {
  1306. interruptible_sleep_on(&(dma->wait));
  1308. if (signal_pending(current))
  1309. return ret ? ret : -ERESTARTSYS;
  1310. }
  1312. hwp = rme96xx_gethwptr(dma->s,exact);
  1314. }; /* count > 0 */
  1316. return ret;
  1317. }
  1319. static ssize_t rme96xx_read(struct file *file, char *buffer,size_t count, loff_t *ppos)
  1320. { 
  1321. struct dmabuf *dma = (struct dmabuf *)file->private_data;
  1322. ssize_t ret = 0;
  1323. int cnt;
  1324. int hop = count/dma->inchannels;
  1325. int hwp;
  1326. int exact = (file->f_flags & O_NONBLOCK); 
  1329. if(dma == NULL || (dma->s) == NULL) 
  1330. return -ENXIO;
  1332. if (ppos != &file->f_pos)
  1333. return -ESPIPE;
  1335. if (dma->mmapped || !dma->opened)
  1336. return -ENXIO;
  1338. if (!access_ok(VERIFY_WRITE, buffer, count))
  1339. return -EFAULT;
  1341. if (! (dma->open_mode  & FMODE_READ))
  1342.                 return -ENXIO;
  1344. if (count > ((dma->s->fragsize*dma->inchannels)>>dma->formatshift))
  1345.     return -EFAULT;
  1347. if (!dma->s->started) rme96xx_startcard(dma->s,exact);
  1348. hwp = rme96xx_gethwptr(dma->s,0);
  1350. if(!(dma->started)){  
  1351. COMM          ("first read")
  1352.      
  1353. dma->writeptr = hwp;
  1354. dma->readptr = hwp;
  1355. dma->started = 1;
  1356. }
  1358.    while (count > 0) {
  1359. cnt = rme96xx_getispace(dma,hwp);
  1360. cnt>>=dma->formatshift;
  1361. cnt*=dma->inchannels;
  1363. if (cnt > count)
  1364. cnt = count;
  1366. if (cnt != 0) {
  1367.         
  1368. if (rme96xx_copytouser(dma,buffer,cnt,hop))
  1369. return ret ? ret : -EFAULT;
  1371. count -= cnt;
  1372. buffer += cnt;
  1373. ret += cnt;
  1374. if (count == 0) return ret;
  1375. }
  1376. if (file->f_flags & O_NONBLOCK)
  1377. return ret ? ret : -EAGAIN;
  1379. if ((hwp - dma->readptr) <= 0) {
  1380. interruptible_sleep_on(&(dma->wait));
  1382. if (signal_pending(current))
  1383. return ret ? ret : -ERESTARTSYS;
  1384. }
  1385. hwp = rme96xx_gethwptr(dma->s,exact);
  1387. }; /* count > 0 */
  1389. return ret;
  1390. }
  1392. static int rm96xx_mmap(struct file *file, struct vm_area_struct *vma) {
  1393. struct dmabuf *dma = (struct dmabuf *)file->private_data;
  1394. rme96xx_info* s = dma->s;
  1395. unsigned long size;
  1397. VALIDATE_STATE(s);
  1398. lock_kernel();
  1400. if (vma->vm_pgoff != 0) {
  1401. unlock_kernel();
  1402. return -EINVAL;
  1403. }
  1404. size = vma->vm_end - vma->vm_start;
  1405. if (size > RME96xx_DMA_MAX_SIZE) {
  1406. unlock_kernel();
  1407. return -EINVAL;
  1408. }
  1411. if (vma->vm_flags & VM_WRITE) {
  1412. if (!s->started) rme96xx_startcard(s,1);
  1414. if (remap_page_range(vma->vm_start, virt_to_phys(s->playbuf + dma->outoffset*RME96xx_DMA_MAX_SIZE), size, vma->vm_page_prot)) {
  1415. unlock_kernel();
  1416. return -EAGAIN;
  1417. }
  1418. } 
  1419. else if (vma->vm_flags & VM_READ) {
  1420. if (!s->started) rme96xx_startcard(s,1);
  1421. if (remap_page_range(vma->vm_start, virt_to_phys(s->playbuf + dma->inoffset*RME96xx_DMA_MAX_SIZE), size, vma->vm_page_prot)) {
  1422. unlock_kernel();
  1423. return -EAGAIN;
  1424. }
  1425. } else  {
  1426. unlock_kernel();
  1427. return -EINVAL;
  1428. }
  1431. /* this is the mapping */
  1433. dma->mmapped = 1;
  1434. unlock_kernel();
  1435. return 0;
  1436. }
  1438. static unsigned int rme96xx_poll(struct file *file, struct poll_table_struct *wait)
  1439. {
  1440. struct dmabuf *dma = (struct dmabuf *)file->private_data;
  1441. rme96xx_info* s = dma->s;
  1442. unsigned int mask = 0;
  1443. unsigned int hwp,cnt;
  1445.         DBG(printk("rme96xx poll_wait ...n"));
  1446. VALIDATE_STATE(s);
  1448. if (!s->started) {
  1449.   mask |= POLLOUT | POLLWRNORM;
  1450. }
  1451. poll_wait(file, &dma->wait, wait);
  1453. hwp = rme96xx_gethwptr(dma->s,0);
  1455.         DBG(printk("rme96xx poll: ..cnt %d > %dn",cnt,s->fragsize));
  1457. cnt = rme96xx_getispace(dma,hwp);
  1459. if (file->f_mode & FMODE_READ) 
  1460.      if (cnt > 0)
  1461.   mask |= POLLIN | POLLRDNORM;
  1465. cnt = rme96xx_getospace(dma,hwp);
  1467. if (file->f_mode & FMODE_WRITE) 
  1468.      if (cnt > 0)
  1469.   mask |= POLLOUT | POLLWRNORM;
  1472. //        printk("rme96xx poll_wait ...%d > %dn",rme96xx_getospace(dma,hwp),rme96xx_getispace(dma,hwp));
  1474. return mask;
  1475. }
  1478. static struct file_operations rme96xx_audio_fops = {
  1479. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
  1480. owner: THIS_MODULE,
  1481. #endif
  1482. read: rme96xx_read,
  1483. write: rme96xx_write,
  1484. poll: rme96xx_poll,
  1485. ioctl: rme96xx_ioctl,  
  1486. mmap: rm96xx_mmap,
  1487. open: rme96xx_open,  
  1488. release: rme96xx_release 
  1489. };
  1491. static int rme96xx_mixer_open(struct inode *inode, struct file *file)
  1492. {
  1493. int minor = MINOR(inode->i_rdev);
  1494. struct list_head *list;
  1495. rme96xx_info *s;
  1497. COMM  ("mixer open");
  1499. for (list = devs.next; ; list = list->next) {
  1500. if (list == &devs)
  1501. return -ENODEV;
  1502. s = list_entry(list, rme96xx_info, devs);
  1503. if (s->mixer== minor)
  1504. break;
  1505. }
  1506.         VALIDATE_STATE(s);
  1507. file->private_data = s;
  1509. COMM                       ("mixer opened")
  1510. return 0;
  1511. }
  1513. static int rme96xx_mixer_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1514. {
  1515. rme96xx_info *s = (rme96xx_info *)file->private_data;
  1516. u32 status;
  1518. status = readl(s->iobase + RME96xx_status_register);
  1520. VALIDATE_STATE(s);
  1521. if (cmd == SOUND_MIXER_PRIVATE1) {
  1522. rme_mixer mixer;
  1523. copy_from_user(&mixer,(void*)arg,sizeof(mixer));
  1525. if (file->f_mode & FMODE_WRITE) {
  1526.      s->dma[mixer.devnr].outoffset = mixer.o_offset;
  1527.      s->dma[mixer.devnr].inoffset = mixer.i_offset;
  1528. }
  1530. mixer.o_offset = s->dma[mixer.devnr].outoffset;
  1531. mixer.i_offset = s->dma[mixer.devnr].inoffset;
  1533. return copy_to_user((void *)arg, &mixer, sizeof(mixer)) ? -EFAULT : 0;
  1534. }
  1535. if (cmd == SOUND_MIXER_PRIVATE2) {
  1536. return put_user(status, (int *)arg);
  1537. }
  1538. if (cmd == SOUND_MIXER_PRIVATE3) {
  1539.      u32 control;
  1540.      copy_from_user(&control,(void*)arg,sizeof(control)); 
  1541.      if (file->f_mode & FMODE_WRITE) {
  1542.   s->control_register = control;
  1543.   writel(control,s->iobase + RME96xx_control_register);
  1544.      }
  1546.      return put_user(s->control_register, (int *)arg);
  1547. }
  1548. return -1;
  1549. }
  1553. static int rme96xx_mixer_release(struct inode *inode, struct file *file)
  1554. {
  1555. return 0;
  1556. }
  1558. static /*const*/ struct file_operations rme96xx_mixer_fops = {
  1559. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
  1560. owner: THIS_MODULE,
  1561. #endif
  1562. ioctl: rme96xx_mixer_ioctl,
  1563. open: rme96xx_mixer_open,
  1564. release: rme96xx_mixer_release,
  1565. };