2 * PC Speaker beeper driver for Linux
4 * Copyright (c) 2002 Vojtech Pavlik
5 * Copyright (c) 1992 Orest Zborowski
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published by
12 * the Free Software Foundation
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/i8253.h>
18 #include <linux/init.h>
19 #include <linux/input.h>
20 #include <linux/platform_device.h>
21 #include <linux/timex.h>
24 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
25 MODULE_DESCRIPTION("PC Speaker beeper driver");
26 MODULE_LICENSE("GPL");
27 MODULE_ALIAS("platform:pcspkr");
29 static int pcspkr_event(struct input_dev
*dev
, unsigned int type
, unsigned int code
, int value
)
31 unsigned int count
= 0;
38 case SND_BELL
: if (value
) value
= 1000;
43 if (value
> 20 && value
< 32767)
44 count
= PIT_TICK_RATE
/ value
;
46 raw_spin_lock_irqsave(&i8253_lock
, flags
);
49 /* set command for counter 2, 2 byte write */
51 /* select desired HZ */
52 outb_p(count
& 0xff, 0x42);
53 outb((count
>> 8) & 0xff, 0x42);
54 /* enable counter 2 */
55 outb_p(inb_p(0x61) | 3, 0x61);
57 /* disable counter 2 */
58 outb(inb_p(0x61) & 0xFC, 0x61);
61 raw_spin_unlock_irqrestore(&i8253_lock
, flags
);
66 static int pcspkr_probe(struct platform_device
*dev
)
68 struct input_dev
*pcspkr_dev
;
71 pcspkr_dev
= input_allocate_device();
75 pcspkr_dev
->name
= "PC Speaker";
76 pcspkr_dev
->phys
= "isa0061/input0";
77 pcspkr_dev
->id
.bustype
= BUS_ISA
;
78 pcspkr_dev
->id
.vendor
= 0x001f;
79 pcspkr_dev
->id
.product
= 0x0001;
80 pcspkr_dev
->id
.version
= 0x0100;
81 pcspkr_dev
->dev
.parent
= &dev
->dev
;
83 pcspkr_dev
->evbit
[0] = BIT_MASK(EV_SND
);
84 pcspkr_dev
->sndbit
[0] = BIT_MASK(SND_BELL
) | BIT_MASK(SND_TONE
);
85 pcspkr_dev
->event
= pcspkr_event
;
87 err
= input_register_device(pcspkr_dev
);
89 input_free_device(pcspkr_dev
);
93 platform_set_drvdata(dev
, pcspkr_dev
);
98 static int pcspkr_remove(struct platform_device
*dev
)
100 struct input_dev
*pcspkr_dev
= platform_get_drvdata(dev
);
102 input_unregister_device(pcspkr_dev
);
103 /* turn off the speaker */
104 pcspkr_event(NULL
, EV_SND
, SND_BELL
, 0);
109 static int pcspkr_suspend(struct device
*dev
)
111 pcspkr_event(NULL
, EV_SND
, SND_BELL
, 0);
116 static void pcspkr_shutdown(struct platform_device
*dev
)
118 /* turn off the speaker */
119 pcspkr_event(NULL
, EV_SND
, SND_BELL
, 0);
122 static const struct dev_pm_ops pcspkr_pm_ops
= {
123 .suspend
= pcspkr_suspend
,
126 static struct platform_driver pcspkr_platform_driver
= {
129 .owner
= THIS_MODULE
,
130 .pm
= &pcspkr_pm_ops
,
132 .probe
= pcspkr_probe
,
133 .remove
= pcspkr_remove
,
134 .shutdown
= pcspkr_shutdown
,
136 module_platform_driver(pcspkr_platform_driver
);