Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Minimalistic braille device kernel support.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * By default, shows console messages on the braille device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * Pressing Insert switches to VC browsing.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *  Copyright (C) Samuel Thibault <samuel.thibault@ens-lyon.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/moduleparam.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/console.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/notifier.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/selection.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/vt_kern.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/consolemap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/keyboard.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/kbd_kern.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) MODULE_AUTHOR("samuel.thibault@ens-lyon.org");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) MODULE_DESCRIPTION("braille device");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30)  * Braille device support part.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) /* Emit various sounds */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) static bool sound;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) module_param(sound, bool, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) MODULE_PARM_DESC(sound, "emit sounds");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) static void beep(unsigned int freq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	if (sound)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 		kd_mksound(freq, HZ/10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) /* mini console */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #define WIDTH 40
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #define BRAILLE_KEY KEY_INSERT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) static u16 console_buf[WIDTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) static int console_cursor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) /* mini view of VC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) static int vc_x, vc_y, lastvc_x, lastvc_y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) /* show console ? (or show VC) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) static int console_show = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) /* pending newline ? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) static int console_newline = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) static int lastVC = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) static struct console *braille_co;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) /* Very VisioBraille-specific */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) static void braille_write(u16 *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	static u16 lastwrite[WIDTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	unsigned char data[1 + 1 + 2*WIDTH + 2 + 1], csum = 0, *c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	u16 out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	if (!braille_co)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	if (!memcmp(lastwrite, buf, WIDTH * sizeof(*buf)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	memcpy(lastwrite, buf, WIDTH * sizeof(*buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) #define SOH 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) #define STX 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) #define ETX 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) #define EOT 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) #define ENQ 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	data[0] = STX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	data[1] = '>';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	csum ^= '>';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	c = &data[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	for (i = 0; i < WIDTH; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		out = buf[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		if (out >= 0x100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 			out = '?';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		else if (out == 0x00)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 			out = ' ';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		csum ^= out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		if (out <= 0x05) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 			*c++ = SOH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 			out |= 0x40;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		*c++ = out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	if (csum <= 0x05) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 		*c++ = SOH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		csum |= 0x40;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	*c++ = csum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	*c++ = ETX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	braille_co->write(braille_co, data, c - data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) /* Follow the VC cursor*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) static void vc_follow_cursor(struct vc_data *vc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	vc_x = vc->state.x - (vc->state.x % WIDTH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	vc_y = vc->state.y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	lastvc_x = vc->state.x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	lastvc_y = vc->state.y;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) /* Maybe the VC cursor moved, if so follow it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) static void vc_maybe_cursor_moved(struct vc_data *vc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	if (vc->state.x != lastvc_x || vc->state.y != lastvc_y)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		vc_follow_cursor(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) /* Show portion of VC at vc_x, vc_y */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) static void vc_refresh(struct vc_data *vc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	u16 buf[WIDTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	for (i = 0; i < WIDTH; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		u16 glyph = screen_glyph(vc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 				2 * (vc_x + i) + vc_y * vc->vc_size_row);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 		buf[i] = inverse_translate(vc, glyph, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	braille_write(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)  * Link to keyboard
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static int keyboard_notifier_call(struct notifier_block *blk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 				  unsigned long code, void *_param)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	struct keyboard_notifier_param *param = _param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	struct vc_data *vc = param->vc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	int ret = NOTIFY_OK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	if (!param->down)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	switch (code) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	case KBD_KEYCODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 		if (console_show) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 			if (param->value == BRAILLE_KEY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 				console_show = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 				beep(880);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 				vc_maybe_cursor_moved(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 				vc_refresh(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 				ret = NOTIFY_STOP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 			ret = NOTIFY_STOP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 			switch (param->value) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 			case KEY_INSERT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 				beep(440);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 				console_show = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 				lastVC = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 				braille_write(console_buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 			case KEY_LEFT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 				if (vc_x > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 					vc_x -= WIDTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 					if (vc_x < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 						vc_x = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 				} else if (vc_y >= 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 					beep(880);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 					vc_y--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 					vc_x = vc->vc_cols-WIDTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 				} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 					beep(220);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 			case KEY_RIGHT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 				if (vc_x + WIDTH < vc->vc_cols) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 					vc_x += WIDTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 				} else if (vc_y + 1 < vc->vc_rows) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 					beep(880);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 					vc_y++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 					vc_x = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 				} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 					beep(220);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 			case KEY_DOWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 				if (vc_y + 1 < vc->vc_rows)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 					vc_y++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 				else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 					beep(220);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 			case KEY_UP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 				if (vc_y >= 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 					vc_y--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 				else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 					beep(220);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 			case KEY_HOME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 				vc_follow_cursor(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 			case KEY_PAGEUP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 				vc_x = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 				vc_y = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 			case KEY_PAGEDOWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 				vc_x = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 				vc_y = vc->vc_rows-1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 			default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 				ret = NOTIFY_OK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			if (ret == NOTIFY_STOP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 				vc_refresh(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	case KBD_POST_KEYSYM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		unsigned char type = KTYP(param->value) - 0xf0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		if (type == KT_SPEC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 			unsigned char val = KVAL(param->value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			int on_off = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 			switch (val) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 			case KVAL(K_CAPS):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 				on_off = vt_get_leds(fg_console, VC_CAPSLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 			case KVAL(K_NUM):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 				on_off = vt_get_leds(fg_console, VC_NUMLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 			case KVAL(K_HOLD):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 				on_off = vt_get_leds(fg_console, VC_SCROLLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 			if (on_off == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 				beep(880);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 			else if (on_off == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 				beep(440);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	case KBD_UNBOUND_KEYCODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	case KBD_UNICODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	case KBD_KEYSYM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 		/* Unused */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) static struct notifier_block keyboard_notifier_block = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	.notifier_call = keyboard_notifier_call,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) static int vt_notifier_call(struct notifier_block *blk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 			    unsigned long code, void *_param)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	struct vt_notifier_param *param = _param;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	struct vc_data *vc = param->vc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	switch (code) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	case VT_ALLOCATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	case VT_DEALLOCATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	case VT_WRITE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 		unsigned char c = param->c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		if (vc->vc_num != fg_console)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		switch (c) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 		case '\b':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		case 127:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 			if (console_cursor > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 				console_cursor--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 				console_buf[console_cursor] = ' ';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 		case '\n':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		case '\v':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		case '\f':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 		case '\r':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 			console_newline = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 		case '\t':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 			c = ' ';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 			fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 			if (c < 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 				/* Ignore other control sequences */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 			if (console_newline) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 				memset(console_buf, 0, sizeof(console_buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 				console_cursor = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 				console_newline = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 			if (console_cursor == WIDTH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 				memmove(console_buf, &console_buf[1],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 					(WIDTH-1) * sizeof(*console_buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 			else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 				console_cursor++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 			console_buf[console_cursor-1] = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 		if (console_show)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 			braille_write(console_buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 			vc_maybe_cursor_moved(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 			vc_refresh(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	case VT_UPDATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 		/* Maybe a VT switch, flush */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 		if (console_show) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 			if (vc->vc_num != lastVC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 				lastVC = vc->vc_num;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 				memset(console_buf, 0, sizeof(console_buf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 				console_cursor = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 				braille_write(console_buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 			vc_maybe_cursor_moved(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 			vc_refresh(vc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	return NOTIFY_OK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) static struct notifier_block vt_notifier_block = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	.notifier_call = vt_notifier_call,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)  * Called from printk.c when console=brl is given
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) int braille_register_console(struct console *console, int index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 		char *console_options, char *braille_options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	if (!console_options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		/* Only support VisioBraille for now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 		console_options = "57600o8";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	if (braille_co)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	if (console->setup) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 		ret = console->setup(console, console_options);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		if (ret != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	console->flags |= CON_ENABLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	console->index = index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	braille_co = console;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	register_keyboard_notifier(&keyboard_notifier_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	register_vt_notifier(&vt_notifier_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) int braille_unregister_console(struct console *console)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 	if (braille_co != console)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 	unregister_keyboard_notifier(&keyboard_notifier_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	unregister_vt_notifier(&vt_notifier_block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	braille_co = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }