Merge branch 'sched/latest' of git://git.kernel.org/pub/scm/linux/kernel/git/ghaskins...
[linux-2.6] / sound / drivers / pcsp / pcsp_lib.c
1 /*
2  * PC-Speaker driver for Linux
3  *
4  * Copyright (C) 1993-1997  Michael Beck
5  * Copyright (C) 1997-2001  David Woodhouse
6  * Copyright (C) 2001-2008  Stas Sergeev
7  */
8
9 #include <linux/module.h>
10 #include <linux/moduleparam.h>
11 #include <linux/interrupt.h>
12 #include <sound/pcm.h>
13 #include <asm/io.h>
14 #include "pcsp.h"
15
16 static int nforce_wa;
17 module_param(nforce_wa, bool, 0444);
18 MODULE_PARM_DESC(nforce_wa, "Apply NForce chipset workaround "
19                 "(expect bad sound)");
20
21 #define DMIX_WANTS_S16  1
22
23 /*
24  * Call snd_pcm_period_elapsed in a tasklet
25  * This avoids spinlock messes and long-running irq contexts
26  */
27 static void pcsp_call_pcm_elapsed(unsigned long priv)
28 {
29         if (atomic_read(&pcsp_chip.timer_active)) {
30                 struct snd_pcm_substream *substream;
31                 substream = pcsp_chip.playback_substream;
32                 if (substream)
33                         snd_pcm_period_elapsed(substream);
34         }
35 }
36
37 static DECLARE_TASKLET(pcsp_pcm_tasklet, pcsp_call_pcm_elapsed, 0);
38
39 /* write the port and returns the next expire time in ns;
40  * called at the trigger-start and in hrtimer callback
41  */
42 static unsigned long pcsp_timer_update(struct hrtimer *handle)
43 {
44         unsigned char timer_cnt, val;
45         u64 ns;
46         struct snd_pcm_substream *substream;
47         struct snd_pcm_runtime *runtime;
48         struct snd_pcsp *chip = container_of(handle, struct snd_pcsp, timer);
49         unsigned long flags;
50
51         if (chip->thalf) {
52                 outb(chip->val61, 0x61);
53                 chip->thalf = 0;
54                 if (!atomic_read(&chip->timer_active))
55                         return 0;
56                 return chip->ns_rem;
57         }
58
59         if (!atomic_read(&chip->timer_active))
60                 return 0;
61         substream = chip->playback_substream;
62         if (!substream)
63                 return 0;
64
65         runtime = substream->runtime;
66         /* assume it is mono! */
67         val = runtime->dma_area[chip->playback_ptr + chip->fmt_size - 1];
68         if (chip->is_signed)
69                 val ^= 0x80;
70         timer_cnt = val * CUR_DIV() / 256;
71
72         if (timer_cnt && chip->enable) {
73                 spin_lock_irqsave(&i8253_lock, flags);
74                 if (!nforce_wa) {
75                         outb_p(chip->val61, 0x61);
76                         outb_p(timer_cnt, 0x42);
77                         outb(chip->val61 ^ 1, 0x61);
78                 } else {
79                         outb(chip->val61 ^ 2, 0x61);
80                         chip->thalf = 1;
81                 }
82                 spin_unlock_irqrestore(&i8253_lock, flags);
83         }
84
85         chip->ns_rem = PCSP_PERIOD_NS();
86         ns = (chip->thalf ? PCSP_CALC_NS(timer_cnt) : chip->ns_rem);
87         chip->ns_rem -= ns;
88         return ns;
89 }
90
91 enum hrtimer_restart pcsp_do_timer(struct hrtimer *handle)
92 {
93         struct snd_pcsp *chip = container_of(handle, struct snd_pcsp, timer);
94         struct snd_pcm_substream *substream;
95         int periods_elapsed, pointer_update;
96         size_t period_bytes, buffer_bytes;
97         unsigned long ns;
98         unsigned long flags;
99
100         pointer_update = !chip->thalf;
101         ns = pcsp_timer_update(handle);
102         if (!ns)
103                 return HRTIMER_NORESTART;
104
105         /* update the playback position */
106         substream = chip->playback_substream;
107         if (!substream)
108                 return HRTIMER_NORESTART;
109
110         period_bytes = snd_pcm_lib_period_bytes(substream);
111         buffer_bytes = snd_pcm_lib_buffer_bytes(substream);
112
113         spin_lock_irqsave(&chip->substream_lock, flags);
114         chip->playback_ptr += PCSP_INDEX_INC() * chip->fmt_size;
115         periods_elapsed = chip->playback_ptr - chip->period_ptr;
116         if (periods_elapsed < 0) {
117 #if PCSP_DEBUG
118                 printk(KERN_INFO "PCSP: buffer_bytes mod period_bytes != 0 ? "
119                         "(%zi %zi %zi)\n",
120                         chip->playback_ptr, period_bytes, buffer_bytes);
121 #endif
122                 periods_elapsed += buffer_bytes;
123         }
124         periods_elapsed /= period_bytes;
125         /* wrap the pointer _before_ calling snd_pcm_period_elapsed(),
126          * or ALSA will BUG on us. */
127         chip->playback_ptr %= buffer_bytes;
128
129         if (periods_elapsed) {
130                 chip->period_ptr += periods_elapsed * period_bytes;
131                 chip->period_ptr %= buffer_bytes;
132         }
133         spin_unlock_irqrestore(&chip->substream_lock, flags);
134
135         if (periods_elapsed)
136                 tasklet_schedule(&pcsp_pcm_tasklet);
137
138         hrtimer_forward(handle, hrtimer_get_expires(handle), ns_to_ktime(ns));
139
140         return HRTIMER_RESTART;
141 }
142
143 static int pcsp_start_playing(struct snd_pcsp *chip)
144 {
145         unsigned long ns;
146
147 #if PCSP_DEBUG
148         printk(KERN_INFO "PCSP: start_playing called\n");
149 #endif
150         if (atomic_read(&chip->timer_active)) {
151                 printk(KERN_ERR "PCSP: Timer already active\n");
152                 return -EIO;
153         }
154
155         spin_lock(&i8253_lock);
156         chip->val61 = inb(0x61) | 0x03;
157         outb_p(0x92, 0x43);     /* binary, mode 1, LSB only, ch 2 */
158         spin_unlock(&i8253_lock);
159         atomic_set(&chip->timer_active, 1);
160         chip->thalf = 0;
161
162         ns = pcsp_timer_update(&pcsp_chip.timer);
163         if (!ns)
164                 return -EIO;
165
166         hrtimer_start(&pcsp_chip.timer, ktime_set(0, ns), HRTIMER_MODE_REL);
167         return 0;
168 }
169
170 static void pcsp_stop_playing(struct snd_pcsp *chip)
171 {
172 #if PCSP_DEBUG
173         printk(KERN_INFO "PCSP: stop_playing called\n");
174 #endif
175         if (!atomic_read(&chip->timer_active))
176                 return;
177
178         atomic_set(&chip->timer_active, 0);
179         spin_lock(&i8253_lock);
180         /* restore the timer */
181         outb_p(0xb6, 0x43);     /* binary, mode 3, LSB/MSB, ch 2 */
182         outb(chip->val61 & 0xFC, 0x61);
183         spin_unlock(&i8253_lock);
184 }
185
186 /*
187  * Force to stop and sync the stream
188  */
189 void pcsp_sync_stop(struct snd_pcsp *chip)
190 {
191         local_irq_disable();
192         pcsp_stop_playing(chip);
193         local_irq_enable();
194         hrtimer_cancel(&chip->timer);
195         tasklet_kill(&pcsp_pcm_tasklet);
196 }
197
198 static int snd_pcsp_playback_close(struct snd_pcm_substream *substream)
199 {
200         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
201 #if PCSP_DEBUG
202         printk(KERN_INFO "PCSP: close called\n");
203 #endif
204         pcsp_sync_stop(chip);
205         chip->playback_substream = NULL;
206         return 0;
207 }
208
209 static int snd_pcsp_playback_hw_params(struct snd_pcm_substream *substream,
210                                        struct snd_pcm_hw_params *hw_params)
211 {
212         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
213         int err;
214         pcsp_sync_stop(chip);
215         err = snd_pcm_lib_malloc_pages(substream,
216                                       params_buffer_bytes(hw_params));
217         if (err < 0)
218                 return err;
219         return 0;
220 }
221
222 static int snd_pcsp_playback_hw_free(struct snd_pcm_substream *substream)
223 {
224         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
225 #if PCSP_DEBUG
226         printk(KERN_INFO "PCSP: hw_free called\n");
227 #endif
228         pcsp_sync_stop(chip);
229         return snd_pcm_lib_free_pages(substream);
230 }
231
232 static int snd_pcsp_playback_prepare(struct snd_pcm_substream *substream)
233 {
234         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
235 #if PCSP_DEBUG
236         printk(KERN_INFO "PCSP: prepare called, "
237                         "size=%zi psize=%zi f=%zi f1=%i\n",
238                         snd_pcm_lib_buffer_bytes(substream),
239                         snd_pcm_lib_period_bytes(substream),
240                         snd_pcm_lib_buffer_bytes(substream) /
241                         snd_pcm_lib_period_bytes(substream),
242                         substream->runtime->periods);
243 #endif
244         pcsp_sync_stop(chip);
245         chip->playback_ptr = 0;
246         chip->period_ptr = 0;
247         chip->fmt_size =
248                 snd_pcm_format_physical_width(substream->runtime->format) >> 3;
249         chip->is_signed = snd_pcm_format_signed(substream->runtime->format);
250         return 0;
251 }
252
253 static int snd_pcsp_trigger(struct snd_pcm_substream *substream, int cmd)
254 {
255         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
256 #if PCSP_DEBUG
257         printk(KERN_INFO "PCSP: trigger called\n");
258 #endif
259         switch (cmd) {
260         case SNDRV_PCM_TRIGGER_START:
261         case SNDRV_PCM_TRIGGER_RESUME:
262                 return pcsp_start_playing(chip);
263         case SNDRV_PCM_TRIGGER_STOP:
264         case SNDRV_PCM_TRIGGER_SUSPEND:
265                 pcsp_stop_playing(chip);
266                 break;
267         default:
268                 return -EINVAL;
269         }
270         return 0;
271 }
272
273 static snd_pcm_uframes_t snd_pcsp_playback_pointer(struct snd_pcm_substream
274                                                    *substream)
275 {
276         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
277         unsigned int pos;
278         spin_lock(&chip->substream_lock);
279         pos = chip->playback_ptr;
280         spin_unlock(&chip->substream_lock);
281         return bytes_to_frames(substream->runtime, pos);
282 }
283
284 static struct snd_pcm_hardware snd_pcsp_playback = {
285         .info = (SNDRV_PCM_INFO_INTERLEAVED |
286                  SNDRV_PCM_INFO_HALF_DUPLEX |
287                  SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID),
288         .formats = (SNDRV_PCM_FMTBIT_U8
289 #if DMIX_WANTS_S16
290                     | SNDRV_PCM_FMTBIT_S16_LE
291 #endif
292             ),
293         .rates = SNDRV_PCM_RATE_KNOT,
294         .rate_min = PCSP_DEFAULT_SRATE,
295         .rate_max = PCSP_DEFAULT_SRATE,
296         .channels_min = 1,
297         .channels_max = 1,
298         .buffer_bytes_max = PCSP_BUFFER_SIZE,
299         .period_bytes_min = 64,
300         .period_bytes_max = PCSP_MAX_PERIOD_SIZE,
301         .periods_min = 2,
302         .periods_max = PCSP_MAX_PERIODS,
303         .fifo_size = 0,
304 };
305
306 static int snd_pcsp_playback_open(struct snd_pcm_substream *substream)
307 {
308         struct snd_pcsp *chip = snd_pcm_substream_chip(substream);
309         struct snd_pcm_runtime *runtime = substream->runtime;
310 #if PCSP_DEBUG
311         printk(KERN_INFO "PCSP: open called\n");
312 #endif
313         if (atomic_read(&chip->timer_active)) {
314                 printk(KERN_ERR "PCSP: still active!!\n");
315                 return -EBUSY;
316         }
317         runtime->hw = snd_pcsp_playback;
318         chip->playback_substream = substream;
319         return 0;
320 }
321
322 static struct snd_pcm_ops snd_pcsp_playback_ops = {
323         .open = snd_pcsp_playback_open,
324         .close = snd_pcsp_playback_close,
325         .ioctl = snd_pcm_lib_ioctl,
326         .hw_params = snd_pcsp_playback_hw_params,
327         .hw_free = snd_pcsp_playback_hw_free,
328         .prepare = snd_pcsp_playback_prepare,
329         .trigger = snd_pcsp_trigger,
330         .pointer = snd_pcsp_playback_pointer,
331 };
332
333 int __devinit snd_pcsp_new_pcm(struct snd_pcsp *chip)
334 {
335         int err;
336
337         err = snd_pcm_new(chip->card, "pcspeaker", 0, 1, 0, &chip->pcm);
338         if (err < 0)
339                 return err;
340
341         snd_pcm_set_ops(chip->pcm, SNDRV_PCM_STREAM_PLAYBACK,
342                         &snd_pcsp_playback_ops);
343
344         chip->pcm->private_data = chip;
345         chip->pcm->info_flags = SNDRV_PCM_INFO_HALF_DUPLEX;
346         strcpy(chip->pcm->name, "pcsp");
347
348         snd_pcm_lib_preallocate_pages_for_all(chip->pcm,
349                                               SNDRV_DMA_TYPE_CONTINUOUS,
350                                               snd_dma_continuous_data
351                                               (GFP_KERNEL), PCSP_BUFFER_SIZE,
352                                               PCSP_BUFFER_SIZE);
353
354         return 0;
355 }