Greg Kroah-Hartman | b244131 | 2017-11-01 15:07:57 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0 |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 2 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 3 | |
| 4 | #include <linux/kernel.h> |
| 5 | #include <linux/console.h> |
Samuel Thibault | 2ed2b86 | 2017-03-26 22:47:36 +0200 | [diff] [blame] | 6 | #include <linux/errno.h> |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 7 | #include <linux/string.h> |
| 8 | |
| 9 | #include "console_cmdline.h" |
| 10 | #include "braille.h" |
| 11 | |
Samuel Thibault | 2ed2b86 | 2017-03-26 22:47:36 +0200 | [diff] [blame] | 12 | int _braille_console_setup(char **str, char **brl_options) |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 13 | { |
Chuhong Yuan | 35c3549 | 2019-08-09 15:10:34 +0800 | [diff] [blame] | 14 | size_t len; |
| 15 | |
| 16 | len = str_has_prefix(*str, "brl,"); |
| 17 | if (len) { |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 18 | *brl_options = ""; |
Chuhong Yuan | 35c3549 | 2019-08-09 15:10:34 +0800 | [diff] [blame] | 19 | *str += len; |
| 20 | return 0; |
| 21 | } |
| 22 | |
| 23 | len = str_has_prefix(*str, "brl="); |
| 24 | if (len) { |
| 25 | *brl_options = *str + len; |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 26 | *str = strchr(*brl_options, ','); |
Samuel Thibault | 2ed2b86 | 2017-03-26 22:47:36 +0200 | [diff] [blame] | 27 | if (!*str) { |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 28 | pr_err("need port name after brl=\n"); |
Samuel Thibault | 2ed2b86 | 2017-03-26 22:47:36 +0200 | [diff] [blame] | 29 | return -EINVAL; |
| 30 | } |
| 31 | *((*str)++) = 0; |
| 32 | } |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 33 | |
Samuel Thibault | 2ed2b86 | 2017-03-26 22:47:36 +0200 | [diff] [blame] | 34 | return 0; |
Joe Perches | bbeddf5 | 2013-07-31 13:53:45 -0700 | [diff] [blame] | 35 | } |
| 36 | |
| 37 | int |
| 38 | _braille_register_console(struct console *console, struct console_cmdline *c) |
| 39 | { |
| 40 | int rtn = 0; |
| 41 | |
| 42 | if (c->brl_options) { |
| 43 | console->flags |= CON_BRL; |
| 44 | rtn = braille_register_console(console, c->index, c->options, |
| 45 | c->brl_options); |
| 46 | } |
| 47 | |
| 48 | return rtn; |
| 49 | } |
| 50 | |
| 51 | int |
| 52 | _braille_unregister_console(struct console *console) |
| 53 | { |
| 54 | if (console->flags & CON_BRL) |
| 55 | return braille_unregister_console(console); |
| 56 | |
| 57 | return 0; |
| 58 | } |