sound: Import latest code from FreeBSD
[dragonfly.git] / sys / dev / sound / pci / ich.c
1 /*-
2  * Copyright (c) 2000 Katsurajima Naoto <raven@katsurajima.seya.yokohama.jp>
3  * Copyright (c) 2001 Cameron Grant <cg@freebsd.org>
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHERIN CONTRACT, STRICT
23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THEPOSSIBILITY OF
25  * SUCH DAMAGE.
26  */
27
28 #ifdef HAVE_KERNEL_OPTION_HEADERS
29 #include "opt_snd.h"
30 #endif
31
32 #include <dev/sound/pcm/sound.h>
33 #include <dev/sound/pcm/ac97.h>
34 #include <dev/sound/pci/ich.h>
35
36 #include <dev/pci/pcireg.h>
37 #include <dev/pci/pcivar.h>
38
39 SND_DECLARE_FILE("$FreeBSD: head/sys/dev/sound/pci/ich.c 216518 2010-12-18 14:21:28Z tijl $");
40
41 /* -------------------------------------------------------------------- */
42
43 #define ICH_TIMEOUT             1000 /* semaphore timeout polling count */
44 #define ICH_DTBL_LENGTH         32
45 #define ICH_DEFAULT_BUFSZ       16384
46 #define ICH_MAX_BUFSZ           65536
47 #define ICH_MIN_BUFSZ           4096
48 #define ICH_DEFAULT_BLKCNT      2
49 #define ICH_MAX_BLKCNT          32
50 #define ICH_MIN_BLKCNT          2
51 #define ICH_MIN_BLKSZ           64
52
53 #define INTEL_VENDORID  0x8086
54 #define SIS_VENDORID    0x1039
55 #define NVIDIA_VENDORID 0x10de
56 #define AMD_VENDORID    0x1022
57
58 #define INTEL_82440MX   0x7195
59 #define INTEL_82801AA   0x2415
60 #define INTEL_82801AB   0x2425
61 #define INTEL_82801BA   0x2445
62 #define INTEL_82801CA   0x2485
63 #define INTEL_82801DB   0x24c5  /* ICH4 needs special handling */
64 #define INTEL_82801EB   0x24d5  /* ICH5 needs to be treated as ICH4 */
65 #define INTEL_6300ESB   0x25a6  /* 6300ESB needs to be treated as ICH4 */
66 #define INTEL_82801FB   0x266e  /* ICH6 needs to be treated as ICH4 */
67 #define INTEL_82801GB   0x27de  /* ICH7 needs to be treated as ICH4 */
68 #define SIS_7012        0x7012  /* SiS 7012 needs special handling */
69 #define NVIDIA_NFORCE   0x01b1
70 #define NVIDIA_NFORCE2  0x006a
71 #define NVIDIA_NFORCE2_400      0x008a
72 #define NVIDIA_NFORCE3  0x00da
73 #define NVIDIA_NFORCE3_250      0x00ea
74 #define NVIDIA_NFORCE4  0x0059
75 #define NVIDIA_NFORCE_410_MCP   0x026b
76 #define NVIDIA_NFORCE4_MCP      0x003a
77 #define AMD_768         0x7445
78 #define AMD_8111        0x746d
79
80 #define ICH_LOCK(sc)            snd_mtxlock((sc)->ich_lock)
81 #define ICH_UNLOCK(sc)          snd_mtxunlock((sc)->ich_lock)
82 #define ICH_LOCK_ASSERT(sc)     snd_mtxassert((sc)->ich_lock)
83
84 #if 0
85 #define ICH_DEBUG(stmt)         do {    \
86         stmt                            \
87 } while (0)
88 #else
89 #define ICH_DEBUG(...)
90 #endif
91
92 #define ICH_CALIBRATE_DONE      (1 << 0)
93 #define ICH_IGNORE_PCR          (1 << 1)
94 #define ICH_IGNORE_RESET        (1 << 2)
95 #define ICH_FIXED_RATE          (1 << 3)
96 #define ICH_DMA_NOCACHE         (1 << 4)
97 #define ICH_HIGH_LATENCY        (1 << 5)
98
99 static const struct ich_type {
100         uint16_t        vendor;
101         uint16_t        devid;
102         uint32_t        options;
103 #define PROBE_LOW       0x01
104         char            *name;
105 } ich_devs[] = {
106         { INTEL_VENDORID,       INTEL_82440MX,  0,
107                 "Intel 440MX" },
108         { INTEL_VENDORID,       INTEL_82801AA,  0,
109                 "Intel ICH (82801AA)" },
110         { INTEL_VENDORID,       INTEL_82801AB,  0,
111                 "Intel ICH (82801AB)" },
112         { INTEL_VENDORID,       INTEL_82801BA,  0,
113                 "Intel ICH2 (82801BA)" },
114         { INTEL_VENDORID,       INTEL_82801CA,  0,
115                 "Intel ICH3 (82801CA)" },
116         { INTEL_VENDORID,       INTEL_82801DB,  PROBE_LOW,
117                 "Intel ICH4 (82801DB)" },
118         { INTEL_VENDORID,       INTEL_82801EB,  PROBE_LOW,
119                 "Intel ICH5 (82801EB)" },
120         { INTEL_VENDORID,       INTEL_6300ESB,  PROBE_LOW,
121                 "Intel 6300ESB" },
122         { INTEL_VENDORID,       INTEL_82801FB,  PROBE_LOW,
123                 "Intel ICH6 (82801FB)" },
124         { INTEL_VENDORID,       INTEL_82801GB,  PROBE_LOW,
125                 "Intel ICH7 (82801GB)" },
126         { SIS_VENDORID,         SIS_7012,       0,
127                 "SiS 7012" },
128         { NVIDIA_VENDORID,      NVIDIA_NFORCE,  0,
129                 "nVidia nForce" },
130         { NVIDIA_VENDORID,      NVIDIA_NFORCE2, 0,
131                 "nVidia nForce2" },
132         { NVIDIA_VENDORID,      NVIDIA_NFORCE2_400,     0,
133                 "nVidia nForce2 400" },
134         { NVIDIA_VENDORID,      NVIDIA_NFORCE3, 0,
135                 "nVidia nForce3" },
136         { NVIDIA_VENDORID,      NVIDIA_NFORCE3_250,     0,
137                 "nVidia nForce3 250" },
138         { NVIDIA_VENDORID,      NVIDIA_NFORCE4, 0,
139                 "nVidia nForce4" },
140         { NVIDIA_VENDORID,      NVIDIA_NFORCE_410_MCP,  0,
141                 "nVidia nForce 410 MCP" },
142         { NVIDIA_VENDORID,      NVIDIA_NFORCE4_MCP,     0,
143                 "nVidia nForce 4 MCP" },
144         { AMD_VENDORID,         AMD_768,        0,
145                 "AMD-768" },
146         { AMD_VENDORID,         AMD_8111,       0,
147                 "AMD-8111" }
148 };
149
150 /* buffer descriptor */
151 struct ich_desc {
152         volatile uint32_t buffer;
153         volatile uint32_t length;
154 };
155
156 struct sc_info;
157
158 /* channel registers */
159 struct sc_chinfo {
160         uint32_t num:8, run:1, run_save:1;
161         uint32_t blksz, blkcnt, spd;
162         uint32_t regbase, spdreg;
163         uint32_t imask;
164         uint32_t civ;
165
166         struct snd_dbuf *buffer;
167         struct pcm_channel *channel;
168         struct sc_info *parent;
169
170         struct ich_desc *dtbl;
171         bus_addr_t desc_addr;
172 };
173
174 /* device private data */
175 struct sc_info {
176         device_t dev;
177         int hasvra, hasvrm, hasmic;
178         unsigned int chnum, bufsz, blkcnt;
179         int sample_size, swap_reg;
180
181         struct resource *nambar, *nabmbar, *irq;
182         int regtype, nambarid, nabmbarid, irqid;
183         bus_space_tag_t nambart, nabmbart;
184         bus_space_handle_t nambarh, nabmbarh;
185         bus_dma_tag_t dmat, chan_dmat;
186         bus_dmamap_t dtmap;
187         void *ih;
188
189         struct ac97_info *codec;
190         struct sc_chinfo ch[3];
191         int ac97rate;
192         struct ich_desc *dtbl;
193         unsigned int dtbl_size;
194         bus_addr_t desc_addr;
195         struct intr_config_hook intrhook;
196         uint16_t vendor;
197         uint16_t devid;
198         uint32_t flags;
199         struct mtx *ich_lock;
200 };
201
202 /* -------------------------------------------------------------------- */
203
204 static uint32_t ich_fmt[] = {
205         SND_FORMAT(AFMT_S16_LE, 2, 0),
206         0
207 };
208 static struct pcmchan_caps ich_vrcaps = {8000, 48000, ich_fmt, 0};
209 static struct pcmchan_caps ich_caps = {48000, 48000, ich_fmt, 0};
210
211 /* -------------------------------------------------------------------- */
212 /* Hardware */
213 static __inline uint32_t
214 ich_rd(struct sc_info *sc, int regno, int size)
215 {
216         switch (size) {
217         case 1:
218                 return (bus_space_read_1(sc->nabmbart, sc->nabmbarh, regno));
219         case 2:
220                 return (bus_space_read_2(sc->nabmbart, sc->nabmbarh, regno));
221         case 4:
222                 return (bus_space_read_4(sc->nabmbart, sc->nabmbarh, regno));
223         default:
224                 return (0xffffffff);
225         }
226 }
227
228 static __inline void
229 ich_wr(struct sc_info *sc, int regno, uint32_t data, int size)
230 {
231         switch (size) {
232         case 1:
233                 bus_space_write_1(sc->nabmbart, sc->nabmbarh, regno, data);
234                 break;
235         case 2:
236                 bus_space_write_2(sc->nabmbart, sc->nabmbarh, regno, data);
237                 break;
238         case 4:
239                 bus_space_write_4(sc->nabmbart, sc->nabmbarh, regno, data);
240                 break;
241         }
242 }
243
244 /* ac97 codec */
245 static int
246 ich_waitcd(void *devinfo)
247 {
248         struct sc_info *sc = (struct sc_info *)devinfo;
249         uint32_t data;
250         int i;
251
252         for (i = 0; i < ICH_TIMEOUT; i++) {
253                 data = ich_rd(sc, ICH_REG_ACC_SEMA, 1);
254                 if ((data & 0x01) == 0)
255                         return (0);
256                 DELAY(1);
257         }
258         if ((sc->flags & ICH_IGNORE_PCR) != 0)
259                 return (0);
260         device_printf(sc->dev, "CODEC semaphore timeout\n");
261         return (ETIMEDOUT);
262 }
263
264 static int
265 ich_rdcd(kobj_t obj, void *devinfo, int regno)
266 {
267         struct sc_info *sc = (struct sc_info *)devinfo;
268
269         regno &= 0xff;
270         ich_waitcd(sc);
271
272         return (bus_space_read_2(sc->nambart, sc->nambarh, regno));
273 }
274
275 static int
276 ich_wrcd(kobj_t obj, void *devinfo, int regno, uint32_t data)
277 {
278         struct sc_info *sc = (struct sc_info *)devinfo;
279
280         regno &= 0xff;
281         ich_waitcd(sc);
282         bus_space_write_2(sc->nambart, sc->nambarh, regno, data);
283
284         return (0);
285 }
286
287 static kobj_method_t ich_ac97_methods[] = {
288         KOBJMETHOD(ac97_read,           ich_rdcd),
289         KOBJMETHOD(ac97_write,          ich_wrcd),
290         KOBJMETHOD_END
291 };
292 AC97_DECLARE(ich_ac97);
293
294 /* -------------------------------------------------------------------- */
295 /* common routines */
296
297 static void
298 ich_filldtbl(struct sc_chinfo *ch)
299 {
300         struct sc_info *sc = ch->parent;
301         uint32_t base;
302         int i;
303
304         base = sndbuf_getbufaddr(ch->buffer);
305         if ((ch->blksz * ch->blkcnt) > sndbuf_getmaxsize(ch->buffer))
306                 ch->blksz = sndbuf_getmaxsize(ch->buffer) / ch->blkcnt;
307         if ((sndbuf_getblksz(ch->buffer) != ch->blksz ||
308             sndbuf_getblkcnt(ch->buffer) != ch->blkcnt) &&
309             sndbuf_resize(ch->buffer, ch->blkcnt, ch->blksz) != 0)
310                 device_printf(sc->dev, "%s: failed blksz=%u blkcnt=%u\n",
311                     __func__, ch->blksz, ch->blkcnt);
312         ch->blksz = sndbuf_getblksz(ch->buffer);
313
314         for (i = 0; i < ICH_DTBL_LENGTH; i++) {
315                 ch->dtbl[i].buffer = base + (ch->blksz * (i % ch->blkcnt));
316                 ch->dtbl[i].length = ICH_BDC_IOC
317                                    | (ch->blksz / ch->parent->sample_size);
318         }
319 }
320
321 static int
322 ich_resetchan(struct sc_info *sc, int num)
323 {
324         int i, cr, regbase;
325
326         if (num == 0)
327                 regbase = ICH_REG_PO_BASE;
328         else if (num == 1)
329                 regbase = ICH_REG_PI_BASE;
330         else if (num == 2)
331                 regbase = ICH_REG_MC_BASE;
332         else
333                 return (ENXIO);
334
335         ich_wr(sc, regbase + ICH_REG_X_CR, 0, 1);
336 #if 1
337         /* This may result in no sound output on NForce 2 MBs, see PR 73987 */
338         DELAY(100);
339 #else
340         (void)ich_rd(sc, regbase + ICH_REG_X_CR, 1);
341 #endif
342         ich_wr(sc, regbase + ICH_REG_X_CR, ICH_X_CR_RR, 1);
343         for (i = 0; i < ICH_TIMEOUT; i++) {
344                 cr = ich_rd(sc, regbase + ICH_REG_X_CR, 1);
345                 if (cr == 0)
346                         return (0);
347                 DELAY(1);
348         }
349
350         if (sc->flags & ICH_IGNORE_RESET)
351                 return (0);
352 #if 0
353         else if (sc->vendor == NVIDIA_VENDORID) {
354                 sc->flags |= ICH_IGNORE_RESET;
355                 device_printf(sc->dev, "ignoring reset failure!\n");
356                 return (0);
357         }
358 #endif
359
360         device_printf(sc->dev, "cannot reset channel %d\n", num);
361         return (ENXIO);
362 }
363
364 /* -------------------------------------------------------------------- */
365 /* channel interface */
366
367 static void *
368 ichchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
369 {
370         struct sc_info *sc = devinfo;
371         struct sc_chinfo *ch;
372         unsigned int num;
373
374         ICH_LOCK(sc);
375         num = sc->chnum++;
376         ch = &sc->ch[num];
377         ch->num = num;
378         ch->buffer = b;
379         ch->channel = c;
380         ch->parent = sc;
381         ch->run = 0;
382         ch->dtbl = sc->dtbl + (ch->num * ICH_DTBL_LENGTH);
383         ch->desc_addr = sc->desc_addr +
384             (ch->num * ICH_DTBL_LENGTH * sizeof(struct ich_desc));
385         ch->blkcnt = sc->blkcnt;
386         ch->blksz = sc->bufsz / ch->blkcnt;
387
388         switch(ch->num) {
389         case 0: /* play */
390                 KASSERT(dir == PCMDIR_PLAY, ("wrong direction"));
391                 ch->regbase = ICH_REG_PO_BASE;
392                 ch->spdreg = (sc->hasvra) ? AC97_REGEXT_FDACRATE : 0;
393                 ch->imask = ICH_GLOB_STA_POINT;
394                 break;
395
396         case 1: /* record */
397                 KASSERT(dir == PCMDIR_REC, ("wrong direction"));
398                 ch->regbase = ICH_REG_PI_BASE;
399                 ch->spdreg = (sc->hasvra) ? AC97_REGEXT_LADCRATE : 0;
400                 ch->imask = ICH_GLOB_STA_PIINT;
401                 break;
402
403         case 2: /* mic */
404                 KASSERT(dir == PCMDIR_REC, ("wrong direction"));
405                 ch->regbase = ICH_REG_MC_BASE;
406                 ch->spdreg = (sc->hasvrm) ? AC97_REGEXT_MADCRATE : 0;
407                 ch->imask = ICH_GLOB_STA_MINT;
408                 break;
409
410         default:
411                 return (NULL);
412         }
413
414         if (sc->flags & ICH_FIXED_RATE)
415                 ch->spdreg = 0;
416
417         ICH_UNLOCK(sc);
418         if (sndbuf_alloc(ch->buffer, sc->chan_dmat,
419             ((sc->flags & ICH_DMA_NOCACHE) ? BUS_DMA_NOCACHE : 0),
420             sc->bufsz) != 0)
421                 return (NULL);
422
423         ICH_LOCK(sc);
424         ich_wr(sc, ch->regbase + ICH_REG_X_BDBAR, (uint32_t)(ch->desc_addr), 4);
425         ICH_UNLOCK(sc);
426
427         return (ch);
428 }
429
430 static int
431 ichchan_setformat(kobj_t obj, void *data, uint32_t format)
432 {
433
434         ICH_DEBUG(
435                 struct sc_chinfo *ch = data;
436                 struct sc_info *sc = ch->parent;
437                 if (!(sc->flags & ICH_CALIBRATE_DONE))
438                         device_printf(sc->dev,
439                             "WARNING: %s() called before calibration!\n",
440                             __func__);
441         );
442
443         return (0);
444 }
445
446 static uint32_t
447 ichchan_setspeed(kobj_t obj, void *data, uint32_t speed)
448 {
449         struct sc_chinfo *ch = data;
450         struct sc_info *sc = ch->parent;
451
452         ICH_DEBUG(
453                 if (!(sc->flags & ICH_CALIBRATE_DONE))
454                         device_printf(sc->dev,
455                             "WARNING: %s() called before calibration!\n",
456                             __func__);
457         );
458
459         if (ch->spdreg) {
460                 int r, ac97rate;
461
462                 ICH_LOCK(sc);
463                 if (sc->ac97rate <= 32000 || sc->ac97rate >= 64000)
464                         sc->ac97rate = 48000;
465                 ac97rate = sc->ac97rate;
466                 ICH_UNLOCK(sc);
467                 r = (speed * 48000) / ac97rate;
468                 /*
469                  * Cast the return value of ac97_setrate() to uint64 so that
470                  * the math don't overflow into the negative range.
471                  */
472                 ch->spd = ((uint64_t)ac97_setrate(sc->codec, ch->spdreg, r) *
473                                 ac97rate) / 48000;
474         } else {
475                 ch->spd = 48000;
476         }
477         return (ch->spd);
478 }
479
480 static uint32_t
481 ichchan_setblocksize(kobj_t obj, void *data, uint32_t blocksize)
482 {
483         struct sc_chinfo *ch = data;
484         struct sc_info *sc = ch->parent;
485
486         ICH_DEBUG(
487                 if (!(sc->flags & ICH_CALIBRATE_DONE))
488                         device_printf(sc->dev,
489                             "WARNING: %s() called before calibration!\n",
490                             __func__);
491         );
492
493         if (sc->flags & ICH_HIGH_LATENCY)
494                 blocksize = sndbuf_getmaxsize(ch->buffer) / ch->blkcnt;
495
496         if (blocksize < ICH_MIN_BLKSZ)
497                 blocksize = ICH_MIN_BLKSZ;
498         blocksize &= ~(ICH_MIN_BLKSZ - 1);
499         ch->blksz = blocksize;
500         ich_filldtbl(ch);
501         ICH_LOCK(sc);
502         ich_wr(sc, ch->regbase + ICH_REG_X_LVI, ch->blkcnt - 1, 1);
503         ICH_UNLOCK(sc);
504
505         return (ch->blksz);
506 }
507
508 static int
509 ichchan_trigger(kobj_t obj, void *data, int go)
510 {
511         struct sc_chinfo *ch = data;
512         struct sc_info *sc = ch->parent;
513
514         ICH_DEBUG(
515                 if (!(sc->flags & ICH_CALIBRATE_DONE))
516                         device_printf(sc->dev,
517                             "WARNING: %s() called before calibration!\n",
518                             __func__);
519         );
520
521         switch (go) {
522         case PCMTRIG_START:
523                 ch->run = 1;
524                 ICH_LOCK(sc);
525                 ich_wr(sc, ch->regbase + ICH_REG_X_BDBAR, (uint32_t)(ch->desc_addr), 4);
526                 ich_wr(sc, ch->regbase + ICH_REG_X_CR, ICH_X_CR_RPBM | ICH_X_CR_LVBIE | ICH_X_CR_IOCE, 1);
527                 ICH_UNLOCK(sc);
528                 break;
529         case PCMTRIG_STOP:
530         case PCMTRIG_ABORT:
531                 ICH_LOCK(sc);
532                 ich_resetchan(sc, ch->num);
533                 ICH_UNLOCK(sc);
534                 ch->run = 0;
535                 break;
536         default:
537                 break;
538         }
539         return (0);
540 }
541
542 static uint32_t
543 ichchan_getptr(kobj_t obj, void *data)
544 {
545         struct sc_chinfo *ch = data;
546         struct sc_info *sc = ch->parent;
547         uint32_t pos;
548
549         ICH_DEBUG(
550                 if (!(sc->flags & ICH_CALIBRATE_DONE))
551                         device_printf(sc->dev,
552                             "WARNING: %s() called before calibration!\n",
553                             __func__);
554         );
555
556         ICH_LOCK(sc);
557         ch->civ = ich_rd(sc, ch->regbase + ICH_REG_X_CIV, 1) % ch->blkcnt;
558         ICH_UNLOCK(sc);
559
560         pos = ch->civ * ch->blksz;
561
562         return (pos);
563 }
564
565 static struct pcmchan_caps *
566 ichchan_getcaps(kobj_t obj, void *data)
567 {
568         struct sc_chinfo *ch = data;
569
570         ICH_DEBUG(
571                 struct sc_info *sc = ch->parent;
572
573                 if (!(sc->flags & ICH_CALIBRATE_DONE))
574                         device_printf(ch->parent->dev,
575                             "WARNING: %s() called before calibration!\n",
576                             __func__);
577         );
578
579         return ((ch->spdreg) ? &ich_vrcaps : &ich_caps);
580 }
581
582 static kobj_method_t ichchan_methods[] = {
583         KOBJMETHOD(channel_init,                ichchan_init),
584         KOBJMETHOD(channel_setformat,           ichchan_setformat),
585         KOBJMETHOD(channel_setspeed,            ichchan_setspeed),
586         KOBJMETHOD(channel_setblocksize,        ichchan_setblocksize),
587         KOBJMETHOD(channel_trigger,             ichchan_trigger),
588         KOBJMETHOD(channel_getptr,              ichchan_getptr),
589         KOBJMETHOD(channel_getcaps,             ichchan_getcaps),
590         KOBJMETHOD_END
591 };
592 CHANNEL_DECLARE(ichchan);
593
594 /* -------------------------------------------------------------------- */
595 /* The interrupt handler */
596
597 static void
598 ich_intr(void *p)
599 {
600         struct sc_info *sc = (struct sc_info *)p;
601         struct sc_chinfo *ch;
602         uint32_t cbi, lbi, lvi, st, gs;
603         int i;
604
605         ICH_LOCK(sc);
606
607         ICH_DEBUG(
608                 if (!(sc->flags & ICH_CALIBRATE_DONE))
609                         device_printf(sc->dev,
610                             "WARNING: %s() called before calibration!\n",
611                             __func__);
612         );
613
614         gs = ich_rd(sc, ICH_REG_GLOB_STA, 4) & ICH_GLOB_STA_IMASK;
615         if (gs & (ICH_GLOB_STA_PRES | ICH_GLOB_STA_SRES)) {
616                 /* Clear resume interrupt(s) - nothing doing with them */
617                 ich_wr(sc, ICH_REG_GLOB_STA, gs, 4);
618         }
619         gs &= ~(ICH_GLOB_STA_PRES | ICH_GLOB_STA_SRES);
620
621         for (i = 0; i < 3; i++) {
622                 ch = &sc->ch[i];
623                 if ((ch->imask & gs) == 0)
624                         continue;
625                 gs &= ~ch->imask;
626                 st = ich_rd(sc, ch->regbase +
627                                 ((sc->swap_reg) ? ICH_REG_X_PICB : ICH_REG_X_SR),
628                             2);
629                 st &= ICH_X_SR_FIFOE | ICH_X_SR_BCIS | ICH_X_SR_LVBCI;
630                 if (st & (ICH_X_SR_BCIS | ICH_X_SR_LVBCI)) {
631                                 /* block complete - update buffer */
632                         if (ch->run) {
633                                 ICH_UNLOCK(sc);
634                                 chn_intr(ch->channel);
635                                 ICH_LOCK(sc);
636                         }
637                         lvi = ich_rd(sc, ch->regbase + ICH_REG_X_LVI, 1);
638                         cbi = ch->civ % ch->blkcnt;
639                         if (cbi == 0)
640                                 cbi = ch->blkcnt - 1;
641                         else
642                                 cbi--;
643                         lbi = lvi % ch->blkcnt;
644                         if (cbi >= lbi)
645                                 lvi += cbi - lbi;
646                         else
647                                 lvi += cbi + ch->blkcnt - lbi;
648                         lvi %= ICH_DTBL_LENGTH;
649                         ich_wr(sc, ch->regbase + ICH_REG_X_LVI, lvi, 1);
650
651                 }
652                 /* clear status bit */
653                 ich_wr(sc, ch->regbase +
654                            ((sc->swap_reg) ? ICH_REG_X_PICB : ICH_REG_X_SR),
655                        st, 2);
656         }
657         ICH_UNLOCK(sc);
658         if (gs != 0) {
659                 device_printf(sc->dev,
660                               "Unhandled interrupt, gs_intr = %x\n", gs);
661         }
662 }
663
664 /* ------------------------------------------------------------------------- */
665 /* Sysctl to control ac97 speed (some boards appear to end up using
666  * XTAL_IN rather than BIT_CLK for link timing).
667  */
668
669 static int
670 ich_initsys(struct sc_info* sc)
671 {
672         /* XXX: this should move to a device specific sysctl "dev.pcm.X.yyy"
673            via device_get_sysctl_*() as discussed on multimedia@ in msg-id
674            <861wujij2q.fsf@xps.des.no> */
675         SYSCTL_ADD_INT(device_get_sysctl_ctx(sc->dev),
676                        SYSCTL_CHILDREN(device_get_sysctl_tree(sc->dev)),
677                        OID_AUTO, "ac97rate", CTLFLAG_RW,
678                        &sc->ac97rate, 48000,
679                        "AC97 link rate (default = 48000)");
680
681         return (0);
682 }
683
684 static void
685 ich_setstatus(struct sc_info *sc)
686 {
687         char status[SND_STATUSLEN];
688
689         snprintf(status, SND_STATUSLEN,
690             "at io 0x%lx, 0x%lx irq %ld bufsz %u %s",
691             rman_get_start(sc->nambar), rman_get_start(sc->nabmbar),
692             rman_get_start(sc->irq), sc->bufsz,PCM_KLDSTRING(snd_ich));
693
694         if (bootverbose && (sc->flags & ICH_DMA_NOCACHE))
695                 device_printf(sc->dev,
696                     "PCI Master abort workaround enabled\n");
697
698         pcm_setstatus(sc->dev, status);
699 }
700
701 /* -------------------------------------------------------------------- */
702 /* Calibrate card to determine the clock source.  The source maybe a
703  * function of the ac97 codec initialization code (to be investigated).
704  */
705
706 static void
707 ich_calibrate(void *arg)
708 {
709         struct sc_info *sc;
710         struct sc_chinfo *ch;
711         struct timeval t1, t2;
712         uint8_t ociv, nciv;
713         uint32_t wait_us, actual_48k_rate, oblkcnt;
714
715         sc = (struct sc_info *)arg;
716         ICH_LOCK(sc);
717         ch = &sc->ch[1];
718
719         if (sc->intrhook.ich_func != NULL) {
720                 config_intrhook_disestablish(&sc->intrhook);
721                 sc->intrhook.ich_func = NULL;
722         }
723
724         /*
725          * Grab audio from input for fixed interval and compare how
726          * much we actually get with what we expect.  Interval needs
727          * to be sufficiently short that no interrupts are
728          * generated.
729          */
730
731         KASSERT(ch->regbase == ICH_REG_PI_BASE, ("wrong direction"));
732
733         oblkcnt = ch->blkcnt;
734         ch->blkcnt = 2;
735         sc->flags |= ICH_CALIBRATE_DONE;
736         ICH_UNLOCK(sc);
737         ichchan_setblocksize(0, ch, sndbuf_getmaxsize(ch->buffer) >> 1);
738         ICH_LOCK(sc);
739         sc->flags &= ~ICH_CALIBRATE_DONE;
740
741         /*
742          * our data format is stereo, 16 bit so each sample is 4 bytes.
743          * assuming we get 48000 samples per second, we get 192000 bytes/sec.
744          * we're going to start recording with interrupts disabled and measure
745          * the time taken for one block to complete.  we know the block size,
746          * we know the time in microseconds, we calculate the sample rate:
747          *
748          * actual_rate [bps] = bytes / (time [s] * 4)
749          * actual_rate [bps] = (bytes * 1000000) / (time [us] * 4)
750          * actual_rate [Hz] = (bytes * 250000) / time [us]
751          */
752
753         /* prepare */
754         ociv = ich_rd(sc, ch->regbase + ICH_REG_X_CIV, 1);
755         nciv = ociv;
756         ich_wr(sc, ch->regbase + ICH_REG_X_BDBAR, (uint32_t)(ch->desc_addr), 4);
757
758         /* start */
759         microtime(&t1);
760         ich_wr(sc, ch->regbase + ICH_REG_X_CR, ICH_X_CR_RPBM, 1);
761
762         /* wait */
763         do {
764                 microtime(&t2);
765                 if (t2.tv_sec - t1.tv_sec > 1)
766                         break;
767                 nciv = ich_rd(sc, ch->regbase + ICH_REG_X_CIV, 1);
768         } while (nciv == ociv);
769
770         /* stop */
771         ich_wr(sc, ch->regbase + ICH_REG_X_CR, 0, 1);
772
773         /* reset */
774         DELAY(100);
775         ich_wr(sc, ch->regbase + ICH_REG_X_CR, ICH_X_CR_RR, 1);
776         ch->blkcnt = oblkcnt;
777
778         /* turn time delta into us */
779         wait_us = ((t2.tv_sec - t1.tv_sec) * 1000000) + t2.tv_usec - t1.tv_usec;
780
781         if (nciv == ociv) {
782                 device_printf(sc->dev, "ac97 link rate calibration timed out after %d us\n", wait_us);
783                 sc->flags |= ICH_CALIBRATE_DONE;
784                 ICH_UNLOCK(sc);
785                 ich_setstatus(sc);
786                 return;
787         }
788
789         /* Just in case the timecounter screwed. It is possible, really. */
790         if (wait_us > 0)
791                 actual_48k_rate = ((uint64_t)ch->blksz * 250000) / wait_us;
792         else
793                 actual_48k_rate = 48000;
794
795         if (actual_48k_rate < 47500 || actual_48k_rate > 48500) {
796                 sc->ac97rate = actual_48k_rate;
797         } else {
798                 sc->ac97rate = 48000;
799         }
800
801         if (bootverbose || sc->ac97rate != 48000) {
802                 device_printf(sc->dev, "measured ac97 link rate at %d Hz", actual_48k_rate);
803                 if (sc->ac97rate != actual_48k_rate)
804                         printf(", will use %d Hz", sc->ac97rate);
805                 printf("\n");
806         }
807         sc->flags |= ICH_CALIBRATE_DONE;
808         ICH_UNLOCK(sc);
809
810         ich_setstatus(sc);
811
812         return;
813 }
814
815 /* -------------------------------------------------------------------- */
816 /* Probe and attach the card */
817
818 static void
819 ich_setmap(void *arg, bus_dma_segment_t *segs, int nseg, int error)
820 {
821         struct sc_info *sc = (struct sc_info *)arg;
822         sc->desc_addr = segs->ds_addr;
823         return;
824 }
825
826 static int
827 ich_init(struct sc_info *sc)
828 {
829         uint32_t stat;
830
831         ich_wr(sc, ICH_REG_GLOB_CNT, ICH_GLOB_CTL_COLD, 4);
832         DELAY(600000);
833         stat = ich_rd(sc, ICH_REG_GLOB_STA, 4);
834
835         if ((stat & ICH_GLOB_STA_PCR) == 0) {
836                 /* ICH4/ICH5 may fail when busmastering is enabled. Continue */
837                 if (sc->vendor == INTEL_VENDORID && (
838                     sc->devid == INTEL_82801DB || sc->devid == INTEL_82801EB ||
839                     sc->devid == INTEL_6300ESB || sc->devid == INTEL_82801FB ||
840                     sc->devid == INTEL_82801GB)) {
841                         sc->flags |= ICH_IGNORE_PCR;
842                         device_printf(sc->dev, "primary codec not ready!\n");
843                 }
844         }
845
846 #if 0
847         ich_wr(sc, ICH_REG_GLOB_CNT, ICH_GLOB_CTL_COLD | ICH_GLOB_CTL_PRES, 4);
848 #else
849         ich_wr(sc, ICH_REG_GLOB_CNT, ICH_GLOB_CTL_COLD, 4);
850 #endif
851
852         if (ich_resetchan(sc, 0) || ich_resetchan(sc, 1))
853                 return (ENXIO);
854         if (sc->hasmic && ich_resetchan(sc, 2))
855                 return (ENXIO);
856
857         return (0);
858 }
859
860 static int
861 ich_pci_probe(device_t dev)
862 {
863         int i;
864         uint16_t devid, vendor;
865
866         vendor = pci_get_vendor(dev);
867         devid = pci_get_device(dev);
868         for (i = 0; i < sizeof(ich_devs)/sizeof(ich_devs[0]); i++) {
869                 if (vendor == ich_devs[i].vendor &&
870                                 devid == ich_devs[i].devid) {
871                         device_set_desc(dev, ich_devs[i].name);
872                         /* allow a better driver to override us */
873                         if ((ich_devs[i].options & PROBE_LOW) != 0)
874                                 return (BUS_PROBE_LOW_PRIORITY);
875                         return (BUS_PROBE_DEFAULT);
876                 }
877         }
878         return (ENXIO);
879 }
880
881 static int
882 ich_pci_attach(device_t dev)
883 {
884         uint32_t                subdev;
885         uint16_t                extcaps;
886         uint16_t                devid, vendor;
887         struct sc_info          *sc;
888         int                     i;
889
890         sc = malloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
891         sc->ich_lock = snd_mtxcreate(device_get_nameunit(dev), "snd_ich softc");
892         sc->dev = dev;
893
894         vendor = sc->vendor = pci_get_vendor(dev);
895         devid = sc->devid = pci_get_device(dev);
896         subdev = (pci_get_subdevice(dev) << 16) | pci_get_subvendor(dev);
897         /*
898          * The SiS 7012 register set isn't quite like the standard ich.
899          * There really should be a general "quirks" mechanism.
900          */
901         if (vendor == SIS_VENDORID && devid == SIS_7012) {
902                 sc->swap_reg = 1;
903                 sc->sample_size = 1;
904         } else {
905                 sc->swap_reg = 0;
906                 sc->sample_size = 2;
907         }
908
909         /*
910          * Intel 440MX Errata #36
911          * - AC97 Soft Audio and Soft Modem Master Abort Errata
912          *
913          * http://www.intel.com/design/chipsets/specupdt/245051.htm
914          */
915         if (vendor == INTEL_VENDORID && devid == INTEL_82440MX)
916                 sc->flags |= ICH_DMA_NOCACHE;
917
918         /*
919          * Enable bus master. On ich4/5 this may prevent the detection of
920          * the primary codec becoming ready in ich_init().
921          */
922         pci_enable_busmaster(dev);
923
924         /*
925          * By default, ich4 has NAMBAR and NABMBAR i/o spaces as
926          * read-only.  Need to enable "legacy support", by poking into
927          * pci config space.  The driver should use MMBAR and MBBAR,
928          * but doing so will mess things up here.  ich4 has enough new
929          * features it warrants it's own driver. 
930          */
931         if (vendor == INTEL_VENDORID && (devid == INTEL_82801DB ||
932             devid == INTEL_82801EB || devid == INTEL_6300ESB ||
933             devid == INTEL_82801FB || devid == INTEL_82801GB)) {
934                 sc->nambarid = PCIR_MMBAR;
935                 sc->nabmbarid = PCIR_MBBAR;
936                 sc->regtype = SYS_RES_MEMORY;
937                 pci_write_config(dev, PCIR_ICH_LEGACY, ICH_LEGACY_ENABLE, 1);
938         } else {
939                 sc->nambarid = PCIR_NAMBAR;
940                 sc->nabmbarid = PCIR_NABMBAR;
941                 sc->regtype = SYS_RES_IOPORT;
942         }
943
944         sc->nambar = bus_alloc_resource_any(dev, sc->regtype, 
945                 &sc->nambarid, RF_ACTIVE);
946         sc->nabmbar = bus_alloc_resource_any(dev, sc->regtype, 
947                 &sc->nabmbarid, RF_ACTIVE);
948
949         if (!sc->nambar || !sc->nabmbar) {
950                 device_printf(dev, "unable to map IO port space\n");
951                 goto bad;
952         }
953
954         sc->nambart = rman_get_bustag(sc->nambar);
955         sc->nambarh = rman_get_bushandle(sc->nambar);
956         sc->nabmbart = rman_get_bustag(sc->nabmbar);
957         sc->nabmbarh = rman_get_bushandle(sc->nabmbar);
958
959         sc->bufsz = pcm_getbuffersize(dev,
960             ICH_MIN_BUFSZ, ICH_DEFAULT_BUFSZ, ICH_MAX_BUFSZ);
961
962         if (resource_int_value(device_get_name(dev),
963             device_get_unit(dev), "blocksize", &i) == 0 && i > 0) {
964                 sc->blkcnt = sc->bufsz / i;
965                 i = 0;
966                 while (sc->blkcnt >> i)
967                         i++;
968                 sc->blkcnt = 1 << (i - 1);
969                 if (sc->blkcnt < ICH_MIN_BLKCNT)
970                         sc->blkcnt = ICH_MIN_BLKCNT;
971                 else if (sc->blkcnt > ICH_MAX_BLKCNT)
972                         sc->blkcnt = ICH_MAX_BLKCNT;
973         } else
974                 sc->blkcnt = ICH_DEFAULT_BLKCNT;
975
976         if (resource_int_value(device_get_name(dev),
977             device_get_unit(dev), "highlatency", &i) == 0 && i != 0) {
978                 sc->flags |= ICH_HIGH_LATENCY;
979                 sc->blkcnt = ICH_MIN_BLKCNT;
980         }
981
982         if (resource_int_value(device_get_name(dev),
983             device_get_unit(dev), "fixedrate", &i) == 0 && i != 0)
984                 sc->flags |= ICH_FIXED_RATE;
985
986         if (resource_int_value(device_get_name(dev),
987             device_get_unit(dev), "micchannel_enabled", &i) == 0 && i != 0)
988                 sc->hasmic = 1;
989
990         sc->irqid = 0;
991         sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irqid,
992             RF_ACTIVE | RF_SHAREABLE);
993         if (!sc->irq || snd_setup_intr(dev, sc->irq, INTR_MPSAFE, ich_intr,
994             sc, &sc->ih)) {
995                 device_printf(dev, "unable to map interrupt\n");
996                 goto bad;
997         }
998
999         if (ich_init(sc)) {
1000                 device_printf(dev, "unable to initialize the card\n");
1001                 goto bad;
1002         }
1003
1004         sc->codec = AC97_CREATE(dev, sc, ich_ac97);
1005         if (sc->codec == NULL)
1006                 goto bad;
1007
1008         /*
1009          * Turn on inverted external amplifier sense flags for few
1010          * 'special' boards.
1011          */
1012         switch (subdev) {
1013         case 0x202f161f:        /* Gateway 7326GZ */
1014         case 0x203a161f:        /* Gateway 4028GZ */
1015         case 0x203e161f:        /* Gateway 3520GZ/M210 */
1016         case 0x204c161f:        /* Kvazar-Micro Senator 3592XT */
1017         case 0x8144104d:        /* Sony VAIO PCG-TR* */
1018         case 0x8197104d:        /* Sony S1XP */
1019         case 0x81c0104d:        /* Sony VAIO type T */
1020         case 0x81c5104d:        /* Sony VAIO VGN B1VP/B1XP */
1021         case 0x3089103c:        /* Compaq Presario B3800 */
1022         case 0x309a103c:        /* HP Compaq nx4300 */
1023         case 0x82131033:        /* NEC VersaPro VJ10F/BH */
1024         case 0x82be1033:        /* NEC VersaPro VJ12F/CH */
1025                 ac97_setflags(sc->codec, ac97_getflags(sc->codec) | AC97_F_EAPD_INV);
1026                 break;
1027         default:
1028                 break;
1029         }
1030
1031         mixer_init(dev, ac97_getmixerclass(), sc->codec);
1032
1033         /* check and set VRA function */
1034         extcaps = ac97_getextcaps(sc->codec);
1035         sc->hasvra = extcaps & AC97_EXTCAP_VRA;
1036         sc->hasvrm = extcaps & AC97_EXTCAP_VRM;
1037         sc->hasmic = (sc->hasmic != 0 &&
1038             (ac97_getcaps(sc->codec) & AC97_CAP_MICCHANNEL)) ? 1 : 0;
1039         ac97_setextmode(sc->codec, sc->hasvra | sc->hasvrm);
1040
1041         sc->dtbl_size = sizeof(struct ich_desc) * ICH_DTBL_LENGTH *
1042             ((sc->hasmic) ? 3 : 2);
1043
1044         /* BDL tag */
1045         if (bus_dma_tag_create(bus_get_dma_tag(dev), 8, 0,
1046             BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL, NULL,
1047             sc->dtbl_size, 1, 0x3ffff, 0, NULL, NULL, &sc->dmat) != 0) {
1048                 device_printf(dev, "unable to create dma tag\n");
1049                 goto bad;
1050         }
1051
1052         /* PCM channel tag */
1053         if (bus_dma_tag_create(bus_get_dma_tag(dev), ICH_MIN_BLKSZ, 0,
1054             BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL, NULL,
1055             sc->bufsz, 1, 0x3ffff, 0, NULL, NULL, &sc->chan_dmat) != 0) {
1056                 device_printf(dev, "unable to create dma tag\n");
1057                 goto bad;
1058         }
1059
1060         if (bus_dmamem_alloc(sc->dmat, (void **)&sc->dtbl, BUS_DMA_NOWAIT |
1061             ((sc->flags & ICH_DMA_NOCACHE) ? BUS_DMA_NOCACHE : 0),
1062             &sc->dtmap))
1063                 goto bad;
1064
1065         if (bus_dmamap_load(sc->dmat, sc->dtmap, sc->dtbl, sc->dtbl_size,
1066             ich_setmap, sc, 0))
1067                 goto bad;
1068
1069         if (pcm_register(dev, sc, 1, (sc->hasmic) ? 2 : 1))
1070                 goto bad;
1071
1072         pcm_addchan(dev, PCMDIR_PLAY, &ichchan_class, sc);              /* play */
1073         pcm_addchan(dev, PCMDIR_REC, &ichchan_class, sc);               /* record */
1074         if (sc->hasmic)
1075                 pcm_addchan(dev, PCMDIR_REC, &ichchan_class, sc);       /* record mic */
1076
1077         if (sc->flags & ICH_FIXED_RATE) {
1078                 sc->flags |= ICH_CALIBRATE_DONE;
1079                 ich_setstatus(sc);
1080         } else {
1081                 ich_initsys(sc);
1082
1083                 sc->intrhook.ich_func = ich_calibrate;
1084                 sc->intrhook.ich_arg = sc;
1085                 if (cold == 0 ||
1086                     config_intrhook_establish(&sc->intrhook) != 0) {
1087                         sc->intrhook.ich_func = NULL;
1088                         ich_calibrate(sc);
1089                 }
1090         }
1091
1092         return (0);
1093
1094 bad:
1095         if (sc->codec)
1096                 ac97_destroy(sc->codec);
1097         if (sc->ih)
1098                 bus_teardown_intr(dev, sc->irq, sc->ih);
1099         if (sc->irq)
1100                 bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1101         if (sc->nambar)
1102                 bus_release_resource(dev, sc->regtype,
1103                     sc->nambarid, sc->nambar);
1104         if (sc->nabmbar)
1105                 bus_release_resource(dev, sc->regtype,
1106                     sc->nabmbarid, sc->nabmbar);
1107         if (sc->dtmap)
1108                 bus_dmamap_unload(sc->dmat, sc->dtmap);
1109         if (sc->dtbl)
1110                 bus_dmamem_free(sc->dmat, sc->dtbl, sc->dtmap);
1111         if (sc->chan_dmat)
1112                 bus_dma_tag_destroy(sc->chan_dmat);
1113         if (sc->dmat)
1114                 bus_dma_tag_destroy(sc->dmat);
1115         if (sc->ich_lock)
1116                 snd_mtxfree(sc->ich_lock);
1117         free(sc, M_DEVBUF);
1118         return (ENXIO);
1119 }
1120
1121 static int
1122 ich_pci_detach(device_t dev)
1123 {
1124         struct sc_info *sc;
1125         int r;
1126
1127         r = pcm_unregister(dev);
1128         if (r)
1129                 return (r);
1130         sc = pcm_getdevinfo(dev);
1131
1132         bus_teardown_intr(dev, sc->irq, sc->ih);
1133         bus_release_resource(dev, SYS_RES_IRQ, sc->irqid, sc->irq);
1134         bus_release_resource(dev, sc->regtype, sc->nambarid, sc->nambar);
1135         bus_release_resource(dev, sc->regtype, sc->nabmbarid, sc->nabmbar);
1136         bus_dmamap_unload(sc->dmat, sc->dtmap);
1137         bus_dmamem_free(sc->dmat, sc->dtbl, sc->dtmap);
1138         bus_dma_tag_destroy(sc->chan_dmat);
1139         bus_dma_tag_destroy(sc->dmat);
1140         snd_mtxfree(sc->ich_lock);
1141         free(sc, M_DEVBUF);
1142         return (0);
1143 }
1144
1145 static void
1146 ich_pci_codec_reset(struct sc_info *sc)
1147 {
1148         int i;
1149         uint32_t control;
1150
1151         control = ich_rd(sc, ICH_REG_GLOB_CNT, 4); 
1152         control &= ~(ICH_GLOB_CTL_SHUT);
1153         control |= (control & ICH_GLOB_CTL_COLD) ?
1154                     ICH_GLOB_CTL_WARM : ICH_GLOB_CTL_COLD;
1155         ich_wr(sc, ICH_REG_GLOB_CNT, control, 4);
1156
1157         for (i = 500000; i; i--) {
1158                 if (ich_rd(sc, ICH_REG_GLOB_STA, 4) & ICH_GLOB_STA_PCR)
1159                         break;          /*              or ICH_SCR? */
1160                 DELAY(1);
1161         }
1162
1163         if (i <= 0)
1164                 printf("%s: time out\n", __func__);
1165 }
1166
1167 static int
1168 ich_pci_suspend(device_t dev)
1169 {
1170         struct sc_info *sc;
1171         int i;
1172
1173         sc = pcm_getdevinfo(dev);
1174         ICH_LOCK(sc);
1175         for (i = 0 ; i < 3; i++) {
1176                 sc->ch[i].run_save = sc->ch[i].run;
1177                 if (sc->ch[i].run) {
1178                         ICH_UNLOCK(sc);
1179                         ichchan_trigger(0, &sc->ch[i], PCMTRIG_ABORT);
1180                         ICH_LOCK(sc);
1181                 }
1182         }
1183         ICH_UNLOCK(sc);
1184         return (0);
1185 }
1186
1187 static int
1188 ich_pci_resume(device_t dev)
1189 {
1190         struct sc_info *sc;
1191         int i;
1192
1193         sc = pcm_getdevinfo(dev);
1194
1195         ICH_LOCK(sc);
1196         /* Reinit audio device */
1197         if (ich_init(sc) == -1) {
1198                 device_printf(dev, "unable to reinitialize the card\n");
1199                 ICH_UNLOCK(sc);
1200                 return (ENXIO);
1201         }
1202         /* Reinit mixer */
1203         ich_pci_codec_reset(sc);
1204         ICH_UNLOCK(sc);
1205         ac97_setextmode(sc->codec, sc->hasvra | sc->hasvrm);
1206         if (mixer_reinit(dev) == -1) {
1207                 device_printf(dev, "unable to reinitialize the mixer\n");
1208                 return (ENXIO);
1209         }
1210         /* Re-start DMA engines */
1211         for (i = 0 ; i < 3; i++) {
1212                 struct sc_chinfo *ch = &sc->ch[i];
1213                 if (sc->ch[i].run_save) {
1214                         ichchan_setblocksize(0, ch, ch->blksz);
1215                         ichchan_setspeed(0, ch, ch->spd);
1216                         ichchan_trigger(0, ch, PCMTRIG_START);
1217                 }
1218         }
1219         return (0);
1220 }
1221
1222 static device_method_t ich_methods[] = {
1223         /* Device interface */
1224         DEVMETHOD(device_probe,         ich_pci_probe),
1225         DEVMETHOD(device_attach,        ich_pci_attach),
1226         DEVMETHOD(device_detach,        ich_pci_detach),
1227         DEVMETHOD(device_suspend,       ich_pci_suspend),
1228         DEVMETHOD(device_resume,        ich_pci_resume),
1229         { 0, 0 }
1230 };
1231
1232 static driver_t ich_driver = {
1233         "pcm",
1234         ich_methods,
1235         PCM_SOFTC_SIZE,
1236 };
1237
1238 DRIVER_MODULE(snd_ich, pci, ich_driver, pcm_devclass, 0, 0);
1239 MODULE_DEPEND(snd_ich, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
1240 MODULE_VERSION(snd_ich, 1);