Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *  PC Speaker beeper driver for Linux
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *  Copyright (c) 2002 Vojtech Pavlik
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *  Copyright (c) 1992 Orest Zborowski
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include "pcsp.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include "pcsp_input.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) static void pcspkr_do_sound(unsigned int count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 	raw_spin_lock_irqsave(&i8253_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 	if (count) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 		/* set command for counter 2, 2 byte write */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 		outb_p(0xB6, 0x43);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 		/* select desired HZ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 		outb_p(count & 0xff, 0x42);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 		outb((count >> 8) & 0xff, 0x42);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 		/* enable counter 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 		outb_p(inb_p(0x61) | 3, 0x61);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 		/* disable counter 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 		outb(inb_p(0x61) & 0xFC, 0x61);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	raw_spin_unlock_irqrestore(&i8253_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) void pcspkr_stop_sound(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	pcspkr_do_sound(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) static int pcspkr_input_event(struct input_dev *dev, unsigned int type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 			      unsigned int code, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	unsigned int count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	if (atomic_read(&pcsp_chip.timer_active) || !pcsp_chip.pcspkr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	case EV_SND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 		switch (code) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 		case SND_BELL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 			if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 				value = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 		case SND_TONE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 			return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	if (value > 20 && value < 32767)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 		count = PIT_TICK_RATE / value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	pcspkr_do_sound(count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) int pcspkr_input_init(struct input_dev **rdev, struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	struct input_dev *input_dev = input_allocate_device();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	if (!input_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	input_dev->name = "PC Speaker";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	input_dev->phys = "isa0061/input0";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	input_dev->id.bustype = BUS_ISA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	input_dev->id.vendor = 0x001f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	input_dev->id.product = 0x0001;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	input_dev->id.version = 0x0100;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	input_dev->dev.parent = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	input_dev->evbit[0] = BIT(EV_SND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	input_dev->sndbit[0] = BIT(SND_BELL) | BIT(SND_TONE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	input_dev->event = pcspkr_input_event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	err = input_register_device(input_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		input_free_device(input_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	*rdev = input_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) int pcspkr_input_remove(struct input_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	pcspkr_stop_sound();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	input_unregister_device(dev);	/* this also does kfree() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) }