sound/pcmcia/pdaudiocf/pdaudiocf_irq.c

   1 /*
   2  * Driver for Sound Core PDAudioCF soundcard
   3  *
   4  * Copyright (c) 2003 by Jaroslav Kysela <perex@perex.cz>
   5  *
   6  *   This program is free software; you can redistribute it and/or modify
   7  *   it under the terms of the GNU General Public License as published by
   8  *   the Free Software Foundation; either version 2 of the License, or
   9  *   (at your option) any later version.
  10  *
  11  *   This program is distributed in the hope that it will be useful,
  12  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *   GNU General Public License for more details.
  15  *
  16  *   You should have received a copy of the GNU General Public License
  17  *   along with this program; if not, write to the Free Software
  18  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  19  */
  20
  21 #include <sound/core.h>
  22 #include "pdaudiocf.h"
  23 #include <sound/initval.h>
  24 #include <asm/irq_regs.h>
  25
  26 /*
  27  *
  28  */
  29 irqreturn_t pdacf_interrupt(int irq, void *dev)
  30 {
  31         struct snd_pdacf *chip = dev;
  32         unsigned short stat;
  33
  34         if ((chip->chip_status & (PDAUDIOCF_STAT_IS_STALE|
  35                                   PDAUDIOCF_STAT_IS_CONFIGURED|
  36                                   PDAUDIOCF_STAT_IS_SUSPENDED)) != PDAUDIOCF_STAT_IS_CONFIGURED)
  37                 return IRQ_HANDLED;     /* IRQ_NONE here? */
  38
  39         stat = inw(chip->port + PDAUDIOCF_REG_ISR);
  40         if (stat & (PDAUDIOCF_IRQLVL|PDAUDIOCF_IRQOVR)) {
  41                 if (stat & PDAUDIOCF_IRQOVR)    /* should never happen */
  42                         snd_printk(KERN_ERR "PDAUDIOCF SRAM buffer overrun detected!\n");
  43                 if (chip->pcm_substream)
  44                         tasklet_hi_schedule(&chip->tq);
  45                 if (!(stat & PDAUDIOCF_IRQAKM))
  46                         stat |= PDAUDIOCF_IRQAKM;       /* check rate */
  47         }
  48         if (get_irq_regs() != NULL)
  49                 snd_ak4117_check_rate_and_errors(chip->ak4117, 0);
  50         return IRQ_HANDLED;
  51 }
  52
  53 static inline void pdacf_transfer_mono16(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
  54 {
  55         while (size-- > 0) {
  56                 *dst++ = inw(rdp_port) ^ xor;
  57                 inw(rdp_port);
  58         }
  59 }
  60
  61 static inline void pdacf_transfer_mono32(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
  62 {
  63         register u16 val1, val2;
  64
  65         while (size-- > 0) {
  66                 val1 = inw(rdp_port);
  67                 val2 = inw(rdp_port);
  68                 inw(rdp_port);
  69                 *dst++ = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
  70         }
  71 }
  72
  73 static inline void pdacf_transfer_stereo16(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
  74 {
  75         while (size-- > 0) {
  76                 *dst++ = inw(rdp_port) ^ xor;
  77                 *dst++ = inw(rdp_port) ^ xor;
  78         }
  79 }
  80
  81 static inline void pdacf_transfer_stereo32(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
  82 {
  83         register u16 val1, val2, val3;
  84
  85         while (size-- > 0) {
  86                 val1 = inw(rdp_port);
  87                 val2 = inw(rdp_port);
  88                 val3 = inw(rdp_port);
  89                 *dst++ = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
  90                 *dst++ = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
  91         }
  92 }
  93
  94 static inline void pdacf_transfer_mono16sw(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
  95 {
  96         while (size-- > 0) {
  97                 *dst++ = swab16(inw(rdp_port) ^ xor);
  98                 inw(rdp_port);
  99         }
 100 }
 101
 102 static inline void pdacf_transfer_mono32sw(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
 103 {
 104         register u16 val1, val2;
 105
 106         while (size-- > 0) {
 107                 val1 = inw(rdp_port);
 108                 val2 = inw(rdp_port);
 109                 inw(rdp_port);
 110                 *dst++ = swab32((((val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor);
 111         }
 112 }
 113
 114 static inline void pdacf_transfer_stereo16sw(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
 115 {
 116         while (size-- > 0) {
 117                 *dst++ = swab16(inw(rdp_port) ^ xor);
 118                 *dst++ = swab16(inw(rdp_port) ^ xor);
 119         }
 120 }
 121
 122 static inline void pdacf_transfer_stereo32sw(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
 123 {
 124         register u16 val1, val2, val3;
 125
 126         while (size-- > 0) {
 127                 val1 = inw(rdp_port);
 128                 val2 = inw(rdp_port);
 129                 val3 = inw(rdp_port);
 130                 *dst++ = swab32((((val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor);
 131                 *dst++ = swab32((((u32)val3 << 16) | (val2 & 0xff00)) ^ xor);
 132         }
 133 }
 134
 135 static inline void pdacf_transfer_mono24le(u8 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
 136 {
 137         register u16 val1, val2;
 138         register u32 xval1;
 139
 140         while (size-- > 0) {
 141                 val1 = inw(rdp_port);
 142                 val2 = inw(rdp_port);
 143                 inw(rdp_port);
 144                 xval1 = (((val2 & 0xff) << 8) | (val1 << 16)) ^ xor;
 145                 *dst++ = (u8)(xval1 >> 8);
 146                 *dst++ = (u8)(xval1 >> 16);
 147                 *dst++ = (u8)(xval1 >> 24);
 148         }
 149 }
 150
 151 static inline void pdacf_transfer_mono24be(u8 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
 152 {
 153         register u16 val1, val2;
 154         register u32 xval1;
 155
 156         while (size-- > 0) {
 157                 val1 = inw(rdp_port);
 158                 val2 = inw(rdp_port);
 159                 inw(rdp_port);
 160                 xval1 = (((val2 & 0xff) << 8) | (val1 << 16)) ^ xor;
 161                 *dst++ = (u8)(xval1 >> 24);
 162                 *dst++ = (u8)(xval1 >> 16);
 163                 *dst++ = (u8)(xval1 >> 8);
 164         }
 165 }
 166
 167 static inline void pdacf_transfer_stereo24le(u8 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
 168 {
 169         register u16 val1, val2, val3;
 170         register u32 xval1, xval2;
 171
 172         while (size-- > 0) {
 173                 val1 = inw(rdp_port);
 174                 val2 = inw(rdp_port);
 175                 val3 = inw(rdp_port);
 176                 xval1 = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
 177                 xval2 = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
 178                 *dst++ = (u8)(xval1 >> 8);
 179                 *dst++ = (u8)(xval1 >> 16);
 180                 *dst++ = (u8)(xval1 >> 24);
 181                 *dst++ = (u8)(xval2 >> 8);
 182                 *dst++ = (u8)(xval2 >> 16);
 183                 *dst++ = (u8)(xval2 >> 24);
 184         }
 185 }
 186
 187 static inline void pdacf_transfer_stereo24be(u8 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
 188 {
 189         register u16 val1, val2, val3;
 190         register u32 xval1, xval2;
 191
 192         while (size-- > 0) {
 193                 val1 = inw(rdp_port);
 194                 val2 = inw(rdp_port);
 195                 val3 = inw(rdp_port);
 196                 xval1 = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
 197                 xval2 = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
 198                 *dst++ = (u8)(xval1 >> 24);
 199                 *dst++ = (u8)(xval1 >> 16);
 200                 *dst++ = (u8)(xval1 >> 8);
 201                 *dst++ = (u8)(xval2 >> 24);
 202                 *dst++ = (u8)(xval2 >> 16);
 203                 *dst++ = (u8)(xval2 >> 8);
 204         }
 205 }
 206
 207 static void pdacf_transfer(struct snd_pdacf *chip, unsigned int size, unsigned int off)
 208 {
 209         unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
 210         unsigned int xor = chip->pcm_xor;
 211
 212         if (chip->pcm_sample == 3) {
 213                 if (chip->pcm_little) {
 214                         if (chip->pcm_channels == 1) {
 215                                 pdacf_transfer_mono24le((char *)chip->pcm_area + (off * 3), xor, size, rdp_port);
 216                         } else {
 217                                 pdacf_transfer_stereo24le((char *)chip->pcm_area + (off * 6), xor, size, rdp_port);
 218                         }
 219                 } else {
 220                         if (chip->pcm_channels == 1) {
 221                                 pdacf_transfer_mono24be((char *)chip->pcm_area + (off * 3), xor, size, rdp_port);
 222                         } else {
 223                                 pdacf_transfer_stereo24be((char *)chip->pcm_area + (off * 6), xor, size, rdp_port);
 224                         }
 225                 }
 226                 return;
 227         }
 228         if (chip->pcm_swab == 0) {
 229                 if (chip->pcm_channels == 1) {
 230                         if (chip->pcm_frame == 2) {
 231                                 pdacf_transfer_mono16((u16 *)chip->pcm_area + off, xor, size, rdp_port);
 232                         } else {
 233                                 pdacf_transfer_mono32((u32 *)chip->pcm_area + off, xor, size, rdp_port);
 234                         }
 235                 } else {
 236                         if (chip->pcm_frame == 2) {
 237                                 pdacf_transfer_stereo16((u16 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
 238                         } else {
 239                                 pdacf_transfer_stereo32((u32 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
 240                         }
 241                 }
 242         } else {
 243                 if (chip->pcm_channels == 1) {
 244                         if (chip->pcm_frame == 2) {
 245                                 pdacf_transfer_mono16sw((u16 *)chip->pcm_area + off, xor, size, rdp_port);
 246                         } else {
 247                                 pdacf_transfer_mono32sw((u32 *)chip->pcm_area + off, xor, size, rdp_port);
 248                         }
 249                 } else {
 250                         if (chip->pcm_frame == 2) {
 251                                 pdacf_transfer_stereo16sw((u16 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
 252                         } else {
 253                                 pdacf_transfer_stereo32sw((u32 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
 254                         }
 255                 }
 256         }
 257 }
 258
 259 void pdacf_tasklet(unsigned long private_data)
 260 {
 261         struct snd_pdacf *chip = (struct snd_pdacf *) private_data;
 262         int size, off, cont, rdp, wdp;
 263
 264         if ((chip->chip_status & (PDAUDIOCF_STAT_IS_STALE|PDAUDIOCF_STAT_IS_CONFIGURED)) != PDAUDIOCF_STAT_IS_CONFIGURED)
 265                 return;
 266
 267         if (chip->pcm_substream == NULL || chip->pcm_substream->runtime == NULL || !snd_pcm_running(chip->pcm_substream))
 268                 return;
 269
 270         rdp = inw(chip->port + PDAUDIOCF_REG_RDP);
 271         wdp = inw(chip->port + PDAUDIOCF_REG_WDP);
 272         // printk("TASKLET: rdp = %x, wdp = %x\n", rdp, wdp);
 273         size = wdp - rdp;
 274         if (size < 0)
 275                 size += 0x10000;
 276         if (size == 0)
 277                 size = 0x10000;
 278         size /= chip->pcm_frame;
 279         if (size > 64)
 280                 size -= 32;
 281
 282 #if 0
 283         chip->pcm_hwptr += size;
 284         chip->pcm_hwptr %= chip->pcm_size;
 285         chip->pcm_tdone += size;
 286         if (chip->pcm_frame == 2) {
 287                 unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
 288                 while (size-- > 0) {
 289                         inw(rdp_port);
 290                         inw(rdp_port);
 291                 }
 292         } else {
 293                 unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
 294                 while (size-- > 0) {
 295                         inw(rdp_port);
 296                         inw(rdp_port);
 297                         inw(rdp_port);
 298                 }
 299         }
 300 #else
 301         off = chip->pcm_hwptr + chip->pcm_tdone;
 302         off %= chip->pcm_size;
 303         chip->pcm_tdone += size;
 304         while (size > 0) {
 305                 cont = chip->pcm_size - off;
 306                 if (cont > size)
 307                         cont = size;
 308                 pdacf_transfer(chip, cont, off);
 309                 off += cont;
 310                 off %= chip->pcm_size;
 311                 size -= cont;
 312         }
 313 #endif
 314         spin_lock(&chip->reg_lock);
 315         while (chip->pcm_tdone >= chip->pcm_period) {
 316                 chip->pcm_hwptr += chip->pcm_period;
 317                 chip->pcm_hwptr %= chip->pcm_size;
 318                 chip->pcm_tdone -= chip->pcm_period;
 319                 spin_unlock(&chip->reg_lock);
 320                 snd_pcm_period_elapsed(chip->pcm_substream);
 321                 spin_lock(&chip->reg_lock);
 322         }
 323         spin_unlock(&chip->reg_lock);
 324         // printk("TASKLET: end\n");
 325 }