cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

m68kspkr.c (3085B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 *  m68k beeper driver for Linux
      4 *
      5 *  Copyright (c) 2002 Richard Zidlicky
      6 *  Copyright (c) 2002 Vojtech Pavlik
      7 *  Copyright (c) 1992 Orest Zborowski
      8 */
      9
     10
     11#include <linux/kernel.h>
     12#include <linux/module.h>
     13#include <linux/init.h>
     14#include <linux/input.h>
     15#include <linux/platform_device.h>
     16#include <asm/machdep.h>
     17#include <asm/io.h>
     18
     19MODULE_AUTHOR("Richard Zidlicky <rz@linux-m68k.org>");
     20MODULE_DESCRIPTION("m68k beeper driver");
     21MODULE_LICENSE("GPL");
     22
     23static struct platform_device *m68kspkr_platform_device;
     24
     25static int m68kspkr_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
     26{
     27	unsigned int count = 0;
     28
     29	if (type != EV_SND)
     30		return -1;
     31
     32	switch (code) {
     33		case SND_BELL: if (value) value = 1000;
     34		case SND_TONE: break;
     35		default: return -1;
     36	}
     37
     38	if (value > 20 && value < 32767)
     39		count = 1193182 / value;
     40
     41	mach_beep(count, -1);
     42
     43	return 0;
     44}
     45
     46static int m68kspkr_probe(struct platform_device *dev)
     47{
     48	struct input_dev *input_dev;
     49	int err;
     50
     51	input_dev = input_allocate_device();
     52	if (!input_dev)
     53		return -ENOMEM;
     54
     55	input_dev->name = "m68k beeper";
     56	input_dev->phys = "m68k/generic";
     57	input_dev->id.bustype = BUS_HOST;
     58	input_dev->id.vendor  = 0x001f;
     59	input_dev->id.product = 0x0001;
     60	input_dev->id.version = 0x0100;
     61	input_dev->dev.parent = &dev->dev;
     62
     63	input_dev->evbit[0] = BIT_MASK(EV_SND);
     64	input_dev->sndbit[0] = BIT_MASK(SND_BELL) | BIT_MASK(SND_TONE);
     65	input_dev->event = m68kspkr_event;
     66
     67	err = input_register_device(input_dev);
     68	if (err) {
     69		input_free_device(input_dev);
     70		return err;
     71	}
     72
     73	platform_set_drvdata(dev, input_dev);
     74
     75	return 0;
     76}
     77
     78static int m68kspkr_remove(struct platform_device *dev)
     79{
     80	struct input_dev *input_dev = platform_get_drvdata(dev);
     81
     82	input_unregister_device(input_dev);
     83	/* turn off the speaker */
     84	m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
     85
     86	return 0;
     87}
     88
     89static void m68kspkr_shutdown(struct platform_device *dev)
     90{
     91	/* turn off the speaker */
     92	m68kspkr_event(NULL, EV_SND, SND_BELL, 0);
     93}
     94
     95static struct platform_driver m68kspkr_platform_driver = {
     96	.driver		= {
     97		.name	= "m68kspkr",
     98	},
     99	.probe		= m68kspkr_probe,
    100	.remove		= m68kspkr_remove,
    101	.shutdown	= m68kspkr_shutdown,
    102};
    103
    104static int __init m68kspkr_init(void)
    105{
    106	int err;
    107
    108	if (!mach_beep) {
    109		printk(KERN_INFO "m68kspkr: no lowlevel beep support\n");
    110		return -ENODEV;
    111        }
    112
    113	err = platform_driver_register(&m68kspkr_platform_driver);
    114	if (err)
    115		return err;
    116
    117	m68kspkr_platform_device = platform_device_alloc("m68kspkr", -1);
    118	if (!m68kspkr_platform_device) {
    119		err = -ENOMEM;
    120		goto err_unregister_driver;
    121	}
    122
    123	err = platform_device_add(m68kspkr_platform_device);
    124	if (err)
    125		goto err_free_device;
    126
    127	return 0;
    128
    129 err_free_device:
    130	platform_device_put(m68kspkr_platform_device);
    131 err_unregister_driver:
    132	platform_driver_unregister(&m68kspkr_platform_driver);
    133
    134	return err;
    135}
    136
    137static void __exit m68kspkr_exit(void)
    138{
    139	platform_device_unregister(m68kspkr_platform_device);
    140	platform_driver_unregister(&m68kspkr_platform_driver);
    141}
    142
    143module_init(m68kspkr_init);
    144module_exit(m68kspkr_exit);