1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds * PC Speaker beeper driver for Linux
41da177e4SLinus Torvalds *
51da177e4SLinus Torvalds * Copyright (c) 2002 Vojtech Pavlik
61da177e4SLinus Torvalds * Copyright (c) 1992 Orest Zborowski
71da177e4SLinus Torvalds */
81da177e4SLinus Torvalds
91da177e4SLinus Torvalds
101da177e4SLinus Torvalds #include <linux/kernel.h>
111da177e4SLinus Torvalds #include <linux/module.h>
1216ba9b06SRalf Baechle #include <linux/i8253.h>
131da177e4SLinus Torvalds #include <linux/input.h>
1459317747SDmitry Torokhov #include <linux/platform_device.h>
1508604bd9SArnd Bergmann #include <linux/timex.h>
169e04b79cSMunir Contractor #include <linux/io.h>
171da177e4SLinus Torvalds
181da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
191da177e4SLinus Torvalds MODULE_DESCRIPTION("PC Speaker beeper driver");
201da177e4SLinus Torvalds MODULE_LICENSE("GPL");
2143cc71eeSKay Sievers MODULE_ALIAS("platform:pcspkr");
221da177e4SLinus Torvalds
pcspkr_event(struct input_dev * dev,unsigned int type,unsigned int code,int value)239e04b79cSMunir Contractor static int pcspkr_event(struct input_dev *dev, unsigned int type,
249e04b79cSMunir Contractor unsigned int code, int value)
251da177e4SLinus Torvalds {
261da177e4SLinus Torvalds unsigned int count = 0;
271da177e4SLinus Torvalds unsigned long flags;
281da177e4SLinus Torvalds
291da177e4SLinus Torvalds if (type != EV_SND)
309e04b79cSMunir Contractor return -EINVAL;
311da177e4SLinus Torvalds
321da177e4SLinus Torvalds switch (code) {
339e04b79cSMunir Contractor case SND_BELL:
349e04b79cSMunir Contractor if (value)
359e04b79cSMunir Contractor value = 1000;
36e9a710bcSGustavo A. R. Silva break;
379e04b79cSMunir Contractor case SND_TONE:
389e04b79cSMunir Contractor break;
399e04b79cSMunir Contractor default:
409e04b79cSMunir Contractor return -EINVAL;
411da177e4SLinus Torvalds }
421da177e4SLinus Torvalds
431da177e4SLinus Torvalds if (value > 20 && value < 32767)
441da177e4SLinus Torvalds count = PIT_TICK_RATE / value;
451da177e4SLinus Torvalds
46ced918ebSThomas Gleixner raw_spin_lock_irqsave(&i8253_lock, flags);
471da177e4SLinus Torvalds
481da177e4SLinus Torvalds if (count) {
491da177e4SLinus Torvalds /* set command for counter 2, 2 byte write */
501da177e4SLinus Torvalds outb_p(0xB6, 0x43);
511da177e4SLinus Torvalds /* select desired HZ */
521da177e4SLinus Torvalds outb_p(count & 0xff, 0x42);
531da177e4SLinus Torvalds outb((count >> 8) & 0xff, 0x42);
5459bdb437SZoltan Devai /* enable counter 2 */
5559bdb437SZoltan Devai outb_p(inb_p(0x61) | 3, 0x61);
561da177e4SLinus Torvalds } else {
571da177e4SLinus Torvalds /* disable counter 2 */
581da177e4SLinus Torvalds outb(inb_p(0x61) & 0xFC, 0x61);
591da177e4SLinus Torvalds }
601da177e4SLinus Torvalds
61ced918ebSThomas Gleixner raw_spin_unlock_irqrestore(&i8253_lock, flags);
621da177e4SLinus Torvalds
631da177e4SLinus Torvalds return 0;
641da177e4SLinus Torvalds }
651da177e4SLinus Torvalds
pcspkr_probe(struct platform_device * dev)665298cc4cSBill Pemberton static int pcspkr_probe(struct platform_device *dev)
671da177e4SLinus Torvalds {
6859317747SDmitry Torokhov struct input_dev *pcspkr_dev;
6959317747SDmitry Torokhov int err;
7059317747SDmitry Torokhov
7176b7cddfSDmitry Torokhov pcspkr_dev = input_allocate_device();
7276b7cddfSDmitry Torokhov if (!pcspkr_dev)
7376b7cddfSDmitry Torokhov return -ENOMEM;
741da177e4SLinus Torvalds
7576b7cddfSDmitry Torokhov pcspkr_dev->name = "PC Speaker";
761259f2b3SDmitry Torokhov pcspkr_dev->phys = "isa0061/input0";
7776b7cddfSDmitry Torokhov pcspkr_dev->id.bustype = BUS_ISA;
7876b7cddfSDmitry Torokhov pcspkr_dev->id.vendor = 0x001f;
7976b7cddfSDmitry Torokhov pcspkr_dev->id.product = 0x0001;
8076b7cddfSDmitry Torokhov pcspkr_dev->id.version = 0x0100;
81293e6392SDmitry Torokhov pcspkr_dev->dev.parent = &dev->dev;
821da177e4SLinus Torvalds
837b19ada2SJiri Slaby pcspkr_dev->evbit[0] = BIT_MASK(EV_SND);
847b19ada2SJiri Slaby pcspkr_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE);
8576b7cddfSDmitry Torokhov pcspkr_dev->event = pcspkr_event;
861da177e4SLinus Torvalds
8759317747SDmitry Torokhov err = input_register_device(pcspkr_dev);
8859317747SDmitry Torokhov if (err) {
8959317747SDmitry Torokhov input_free_device(pcspkr_dev);
9059317747SDmitry Torokhov return err;
9159317747SDmitry Torokhov }
9259317747SDmitry Torokhov
9359317747SDmitry Torokhov platform_set_drvdata(dev, pcspkr_dev);
941da177e4SLinus Torvalds
951da177e4SLinus Torvalds return 0;
961da177e4SLinus Torvalds }
971da177e4SLinus Torvalds
pcspkr_remove(struct platform_device * dev)98*5cd345ecSUwe Kleine-König static void pcspkr_remove(struct platform_device *dev)
991da177e4SLinus Torvalds {
10059317747SDmitry Torokhov struct input_dev *pcspkr_dev = platform_get_drvdata(dev);
10159317747SDmitry Torokhov
10276b7cddfSDmitry Torokhov input_unregister_device(pcspkr_dev);
1031da177e4SLinus Torvalds /* turn off the speaker */
1041da177e4SLinus Torvalds pcspkr_event(NULL, EV_SND, SND_BELL, 0);
10559317747SDmitry Torokhov }
10659317747SDmitry Torokhov
pcspkr_suspend(struct device * dev)10735db715bSFrans Pop static int pcspkr_suspend(struct device *dev)
10859317747SDmitry Torokhov {
10959317747SDmitry Torokhov pcspkr_event(NULL, EV_SND, SND_BELL, 0);
11059317747SDmitry Torokhov
11159317747SDmitry Torokhov return 0;
11259317747SDmitry Torokhov }
11359317747SDmitry Torokhov
pcspkr_shutdown(struct platform_device * dev)11459317747SDmitry Torokhov static void pcspkr_shutdown(struct platform_device *dev)
11559317747SDmitry Torokhov {
11659317747SDmitry Torokhov /* turn off the speaker */
11759317747SDmitry Torokhov pcspkr_event(NULL, EV_SND, SND_BELL, 0);
11859317747SDmitry Torokhov }
11959317747SDmitry Torokhov
12047145210SAlexey Dobriyan static const struct dev_pm_ops pcspkr_pm_ops = {
12135db715bSFrans Pop .suspend = pcspkr_suspend,
12235db715bSFrans Pop };
12335db715bSFrans Pop
12459317747SDmitry Torokhov static struct platform_driver pcspkr_platform_driver = {
12559317747SDmitry Torokhov .driver = {
12659317747SDmitry Torokhov .name = "pcspkr",
12735db715bSFrans Pop .pm = &pcspkr_pm_ops,
12859317747SDmitry Torokhov },
12959317747SDmitry Torokhov .probe = pcspkr_probe,
130*5cd345ecSUwe Kleine-König .remove_new = pcspkr_remove,
13159317747SDmitry Torokhov .shutdown = pcspkr_shutdown,
13259317747SDmitry Torokhov };
133840a746bSJJ Ding module_platform_driver(pcspkr_platform_driver);
13459317747SDmitry Torokhov
135