2 * (C) Copyright 2004 Intracom S.A.
3 * Pantelis Antoniou <panto@intracom.gr>
5 * SPDX-License-Identifier: GPL-2.0+
11 * A phone based console
13 * Virtual display of 80x24 characters.
14 * The actual display is much smaller and panned to show the virtual one.
15 * Input is made by a numeric keypad utilizing the input method of
16 * mobile phones. Sorry no T9 lexicons...
23 #include <linux/types.h>
24 #include <stdio_dev.h>
28 /*************************************************************************************************/
33 #define REFRESH_HZ (CONFIG_SYS_HZ/50) /* refresh every 20ms */
34 #define BLINK_HZ (CONFIG_SYS_HZ/2) /* cursor blink every 500ms */
36 /*************************************************************************************************/
38 #define DISPLAY_BACKLIT_PORT ((volatile immap_t *)CONFIG_SYS_IMMR)->im_ioport.iop_pcdat
39 #define DISPLAY_BACKLIT_MASK 0x0010
41 /*************************************************************************************************/
43 #define KP_STABLE_HZ (CONFIG_SYS_HZ/100) /* stable for 10ms */
44 #define KP_REPEAT_DELAY_HZ (CONFIG_SYS_HZ/4) /* delay before repeat 250ms */
45 #define KP_REPEAT_HZ (CONFIG_SYS_HZ/20) /* repeat every 50ms */
46 #define KP_FORCE_DELAY_HZ (CONFIG_SYS_HZ/2) /* key was force pressed */
47 #define KP_IDLE_DELAY_HZ (CONFIG_SYS_HZ/2) /* key was released and idle */
49 #if CONFIG_NETPHONE_VERSION == 1
50 #define KP_SPI_RXD_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_ioport.iop_pcdat)
51 #define KP_SPI_RXD_MASK 0x0008
53 #define KP_SPI_TXD_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_ioport.iop_pcdat)
54 #define KP_SPI_TXD_MASK 0x0004
56 #define KP_SPI_CLK_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_ioport.iop_pcdat)
57 #define KP_SPI_CLK_MASK 0x0001
58 #elif CONFIG_NETPHONE_VERSION == 2
59 #define KP_SPI_RXD_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_cpm.cp_pbdat)
60 #define KP_SPI_RXD_MASK 0x00000008
62 #define KP_SPI_TXD_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_cpm.cp_pbdat)
63 #define KP_SPI_TXD_MASK 0x00000004
65 #define KP_SPI_CLK_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_cpm.cp_pbdat)
66 #define KP_SPI_CLK_MASK 0x00000002
69 #define KP_CS_PORT (((volatile immap_t *)CONFIG_SYS_IMMR)->im_cpm.cp_pedat)
70 #define KP_CS_MASK 0x00000010
72 #define KP_SPI_RXD() (KP_SPI_RXD_PORT & KP_SPI_RXD_MASK)
74 #define KP_SPI_TXD(x) \
77 KP_SPI_TXD_PORT |= KP_SPI_TXD_MASK; \
79 KP_SPI_TXD_PORT &= ~KP_SPI_TXD_MASK; \
82 #define KP_SPI_CLK(x) \
85 KP_SPI_CLK_PORT |= KP_SPI_CLK_MASK; \
87 KP_SPI_CLK_PORT &= ~KP_SPI_CLK_MASK; \
90 #define KP_SPI_CLK_TOGGLE() (KP_SPI_CLK_PORT ^= KP_SPI_CLK_MASK)
92 #define KP_SPI_BIT_DELAY() /* no delay */
97 KP_CS_PORT |= KP_CS_MASK; \
99 KP_CS_PORT &= ~KP_CS_MASK; \
105 #define KP_ROWS_MASK ((1 << KP_ROWS) - 1)
106 #define KP_COLS_MASK ((1 << KP_COLS) - 1)
109 #define SCAN_FILTER 1
111 #define SCAN_COL_FILTER 3
114 #define KP_F1 0 /* leftmost dot (tab) */
115 #define KP_F2 1 /* middle left dot */
116 #define KP_F3 2 /* up */
117 #define KP_F4 3 /* middle right dot */
118 #define KP_F5 4 /* rightmost dot */
119 #define KP_F6 5 /* C */
120 #define KP_F7 6 /* left */
121 #define KP_F8 7 /* down */
122 #define KP_F9 8 /* right */
123 #define KP_F10 9 /* enter */
124 #define KP_F11 10 /* R */
125 #define KP_F12 11 /* save */
126 #define KP_F13 12 /* redial */
127 #define KP_F14 13 /* speaker */
128 #define KP_F15 14 /* unused */
129 #define KP_F16 15 /* unused */
131 #define KP_RELEASE -1 /* key depressed */
132 #define KP_FORCE -2 /* key was pressed for more than force hz */
133 #define KP_IDLE -3 /* key was released and idle */
148 /*************************************************************************************************/
150 static int curs_disabled;
151 static int curs_col, curs_row;
152 static int disp_col, disp_row;
154 static int width, height;
156 /* the simulated vty buffer */
157 static char vty_buf[ROWS * COLS];
158 static char last_visible_buf[ROWS * COLS]; /* worst case */
159 static char *last_visible_curs_ptr;
160 static int last_visible_curs_rev;
161 static int blinked_state;
162 static int last_input_mode;
163 static int refresh_time;
164 static int blink_time;
165 static char last_fast_punct;
167 /*************************************************************************************************/
173 static int input_mode;
174 static char fast_punct;
175 static int tab_indicator;
176 static const char *fast_punct_list = ",.:;*";
178 static const char *input_mode_txt[] = { "abc", "ABC", "123" };
180 static const char *punct = ".,!;?'\"-()@/:_+&%*=<>$[]{}\\~^#|";
181 static const char *whspace = " 0\n";
182 /* per mode character select (for 2-9) */
183 static const char *digits_sel[2][8] = {
205 /*****************************************************************************/
207 static void update(void);
208 static void ensure_visible(int col, int row, int dx, int dy);
210 static void console_init(void)
219 input_mode = IM_SMALL;
221 last_fast_punct = '\0';
222 refresh_time = REFRESH_HZ;
223 blink_time = BLINK_HZ;
225 memset(vty_buf, ' ', sizeof(vty_buf));
227 memset(last_visible_buf, ' ', sizeof(last_visible_buf));
228 last_visible_curs_ptr = NULL;
229 last_input_mode = -1;
230 last_visible_curs_rev = 0;
235 width = sed156x_text_width;
236 height = sed156x_text_height - 1;
241 /*****************************************************************************/
243 void phone_putc(const char c);
245 /*****************************************************************************/
247 static int queued_char = -1;
248 static int enabled = 0;
250 /*****************************************************************************/
253 int phone_start(void)
261 queued_char = 'U' - '@';
264 DISPLAY_BACKLIT_PORT &= ~DISPLAY_BACKLIT_MASK;
277 DISPLAY_BACKLIT_PORT |= DISPLAY_BACKLIT_MASK;
282 void phone_puts(const char *s)
284 int count = strlen(s);
292 return queued_char >= 0 ? 1 : 0;
308 /*****************************************************************************/
310 int drv_phone_init(void)
312 struct stdio_dev console_dev;
316 memset(&console_dev, 0, sizeof(console_dev));
317 strcpy(console_dev.name, "phone");
318 console_dev.ext = DEV_EXT_VIDEO; /* Video extensions */
319 console_dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
320 console_dev.start = phone_start;
321 console_dev.stop = phone_stop;
322 console_dev.putc = phone_putc; /* 'putc' function */
323 console_dev.puts = phone_puts; /* 'puts' function */
324 console_dev.tstc = phone_tstc; /* 'tstc' function */
325 console_dev.getc = phone_getc; /* 'getc' function */
327 if (stdio_register(&console_dev) == 0)
335 int drv_phone_use_me(void)
340 static void kp_do_poll(void);
342 void phone_console_do_poll(void)
350 blink_time -= PHONE_CONSOLE_POLL_HZ;
351 if (blink_time <= 0) {
352 blink_time += BLINK_HZ;
353 if (last_visible_curs_ptr) {
354 i = last_visible_curs_ptr - last_visible_buf;
355 x = i % width; y = i / width;
356 sed156x_reverse_at(x, y, 1);
357 last_visible_curs_rev ^= 1;
362 refresh_time -= PHONE_CONSOLE_POLL_HZ;
363 if (refresh_time <= 0) {
364 refresh_time += REFRESH_HZ;
371 static int last_scancode = -1;
372 static int forced_scancode = 0;
373 static int input_state = -1;
374 static int input_scancode = -1;
375 static int input_selected_char = -1;
376 static char input_covered_char;
378 static void putchar_at_cursor(char c)
380 vty_buf[curs_row * COLS + curs_col] = c;
381 ensure_visible(curs_col, curs_row, 1, 1);
384 static char getchar_at_cursor(void)
386 return vty_buf[curs_row * COLS + curs_col];
389 static void queue_input_char(char c)
397 static void terminate_input(void)
402 if (input_selected_char >= 0)
403 queue_input_char(input_selected_char);
406 input_selected_char = -1;
407 putchar_at_cursor(input_covered_char);
410 blink_time = BLINK_HZ;
414 static void handle_enabled_scancode(int scancode)
417 int new_disp_col, new_disp_row;
423 /* key was released */
431 switch (last_scancode) {
433 if (input_mode == IM_NUMBER) {
434 input_mode = IM_CAPITAL;
435 /* queue backspace to erase # */
436 queue_input_char('\b');
438 input_mode = IM_NUMBER;
445 case '2': case '3': case '4': case '5':
446 case '6': case '7': case '8': case '9':
451 input_selected_char = last_scancode;
452 putchar_at_cursor((char)input_selected_char);
463 /* release and idle */
471 /* change input mode */
473 if (last_scancode == '#') /* no repeat */
476 if (input_mode == IM_NUMBER) {
477 input_scancode = scancode;
479 input_selected_char = scancode;
480 input_covered_char = getchar_at_cursor();
481 putchar_at_cursor((char)input_selected_char);
486 if (input_mode == IM_SMALL)
487 input_mode = IM_CAPITAL;
489 input_mode = IM_SMALL;
496 if (last_scancode == scancode)
499 if (input_state >= 0)
502 input_scancode = fast_punct;
504 input_selected_char = input_scancode;
505 input_covered_char = getchar_at_cursor();
506 putchar_at_cursor((char)input_selected_char);
512 case '2': case '3': case '4': case '5':
513 case '6': case '7': case '8': case '9':
516 if (last_scancode == scancode)
519 if (input_mode == IM_NUMBER) {
520 input_scancode = scancode;
522 input_selected_char = scancode;
523 input_covered_char = getchar_at_cursor();
524 putchar_at_cursor((char)input_selected_char);
529 if (input_state >= 0 && input_scancode != scancode)
532 if (input_state < 0) {
534 input_scancode = scancode;
536 input_covered_char = getchar_at_cursor();
542 else if (scancode == '1')
545 sel = digits_sel[input_mode][scancode - '2'];
546 c = *(sel + input_state);
552 input_selected_char = (int)c;
553 putchar_at_cursor((char)input_selected_char);
558 /* move visible display */
559 case KP_F3: case KP_F8: case KP_F7: case KP_F9:
561 new_disp_col = disp_col;
562 new_disp_row = disp_row;
567 if (new_disp_row <= 0)
574 if (new_disp_row >= ROWS - height)
581 if (new_disp_col <= 0)
588 if (new_disp_col >= COLS - width)
595 if (disp_col == new_disp_col && disp_row == new_disp_row)
598 disp_col = new_disp_col;
599 disp_row = new_disp_row;
604 case KP_F6: /* backspace */
605 /* inputing something; no backspace sent, just cancel input */
606 if (input_state >= 0) {
607 input_selected_char = -1; /* cancel */
611 queue_input_char('\b');
614 case KP_F10: /* enter */
615 /* inputing something; first cancel input */
616 if (input_state >= 0)
618 queue_input_char('\r');
621 case KP_F11: /* R -> Ctrl-C (abort) */
622 if (input_state >= 0)
624 queue_input_char('C' - 'Q'); /* ctrl-c */
627 case KP_F5: /* F% -> Ctrl-U (clear line) */
628 if (input_state >= 0)
630 queue_input_char('U' - 'Q'); /* ctrl-c */
634 case KP_F1: /* tab */
635 /* inputing something; first cancel input */
636 if (input_state >= 0)
638 queue_input_char('\t');
641 case KP_F2: /* change fast punct */
642 sel = strchr(fast_punct_list, fast_punct);
644 sel = &fast_punct_list[0];
647 sel = &fast_punct_list[0];
655 if (scancode != KP_FORCE && scancode != KP_IDLE) /* don't record forced or idle scancode */
656 last_scancode = scancode;
659 static void scancode_action(int scancode)
662 if (scancode == KP_RELEASE)
663 printf(" RELEASE\n");
664 else if (scancode == KP_FORCE)
666 else if (scancode == KP_IDLE)
668 else if (scancode < 32)
669 printf(" F%d", scancode + 1);
671 printf(" %c", (char)scancode);
676 handle_enabled_scancode(scancode);
680 if (scancode == KP_FORCE && last_scancode == '*')
683 last_scancode = scancode;
686 /**************************************************************************************/
688 /* update the display; make sure to update only the differences */
689 static void update(void)
692 char *s, *e, *t, *r, *b, *cp;
694 if (input_mode != last_input_mode)
695 sed156x_output_at(sed156x_text_width - 3, sed156x_text_height - 1, input_mode_txt[input_mode], 3);
697 if (tab_indicator == 0) {
698 sed156x_output_at(0, sed156x_text_height - 1, "\\t", 2);
702 if (fast_punct != last_fast_punct)
703 sed156x_output_at(4, sed156x_text_height - 1, &fast_punct, 1);
706 curs_col < disp_col || curs_col >= (disp_col + width) ||
707 curs_row < disp_row || curs_row >= (disp_row + height)) {
710 cp = last_visible_buf + (curs_row - disp_row) * width + (curs_col - disp_col);
713 /* printf("(%d,%d) (%d,%d) %s\n", curs_col, curs_row, disp_col, disp_row, cp ? "YES" : "no"); */
715 /* clear previous cursor */
716 if (last_visible_curs_ptr && last_visible_curs_rev == 0) {
717 i = last_visible_curs_ptr - last_visible_buf;
718 sed156x_reverse_at(i % width, i / width, 1);
721 b = vty_buf + disp_row * COLS + disp_col;
722 t = last_visible_buf;
723 for (i = 0; i < height; i++) {
726 /* update only the differences */
728 while (s < e && *s == *t) {
732 if (s == e) /* no more */
737 while (s < e && *s != *t)
741 sed156x_output_at(r - b, i, r, s - r);
750 last_visible_curs_ptr = cp;
751 i = last_visible_curs_ptr - last_visible_buf;
752 sed156x_reverse_at(i % width, i / width, 1);
753 last_visible_curs_rev = 0;
755 last_visible_curs_ptr = NULL;
758 last_input_mode = input_mode;
759 last_fast_punct = fast_punct;
762 /* ensure visibility; the trick is to minimize the screen movement */
763 static void ensure_visible(int col, int row, int dx, int dy)
765 int x1, y1, x2, y2, a1, b1, a2, b2;
767 /* clamp visible region */
789 /* move to easier to use vars */
790 x1 = disp_col; y1 = disp_row;
791 x2 = x1 + width; y2 = y1 + height;
793 a2 = a1 + dx; b2 = b1 + dy;
795 /* printf("(%d,%d) - (%d,%d) : (%d, %d) - (%d, %d)\n", x1, y1, x2, y2, a1, b1, a2, b2); */
798 /* move to the right */
805 } else if (a1 < x1) {
806 /* move to the left */
823 } else if (b1 < y1) {
833 /* printf("(%d,%d) - (%d,%d) : (%d, %d) - (%d, %d)\n", x1, y1, x2, y2, a1, b1, a2, b2); */
836 if (disp_col == x1 && disp_row == y1)
843 /**************************************************************************************/
845 static void newline(void)
848 if (curs_row + 1 < ROWS)
851 memmove(vty_buf, vty_buf + COLS, COLS * (ROWS - 1));
852 memset(vty_buf + (ROWS - 1) * COLS, ' ', COLS);
856 void phone_putc(const char c)
860 if (input_mode != -1) {
861 input_selected_char = -1;
868 blink_time = BLINK_HZ;
871 case '\a': /* ignore bell */
872 case '\r': /* ignore carriage return */
875 case '\n': /* next line */
877 ensure_visible(curs_col, curs_row, 1, 1);
891 ensure_visible(curs_col, curs_row, 1, 1);
894 case 8: /* backspace */
899 /* make sure that we see a couple of characters before */
901 ensure_visible(curs_col - 4, curs_row, 4, 1);
903 ensure_visible(curs_col, curs_row, 1, 1);
907 default: /* draw the char */
908 putchar_at_cursor(c);
913 if (curs_col + 1 < COLS)
918 ensure_visible(curs_col, curs_row, 1, 1);
924 blink_time = BLINK_HZ;
928 /**************************************************************************************/
930 static inline unsigned int kp_transfer(unsigned int val)
937 KP_SPI_TXD(val & 0x80);
951 unsigned int kp_data_transfer(unsigned int val)
955 val = kp_transfer(val);
961 unsigned int kp_get_col_mask(unsigned int row_mask)
963 unsigned int val, col_mask;
965 val = 0x80 | (row_mask & 0x7F);
966 (void)kp_data_transfer(val);
967 #if CONFIG_NETPHONE_VERSION == 1
968 col_mask = kp_data_transfer(val) & 0x0F;
969 #elif CONFIG_NETPHONE_VERSION == 2
970 col_mask = ((volatile immap_t *)CONFIG_SYS_IMMR)->im_cpm.cp_pedat & 0x0f;
971 /* XXX FUCK FUCK FUCK FUCK FUCK!!!! */
972 col_mask = ((col_mask & 0x08) >> 3) | /* BKBR1 */
973 ((col_mask & 0x04) << 1) | /* BKBR2 */
974 (col_mask & 0x02) | /* BKBR3 */
975 ((col_mask & 0x01) << 2); /* BKBR4 */
978 /* printf("col_mask(row_mask = 0x%x) -> col_mask = 0x%x\n", row_mask, col_mask); */
983 /**************************************************************************************/
985 static const int kp_scancodes[KP_ROWS * KP_COLS] = {
986 KP_F1, KP_F3, KP_F4, KP_F2,
987 KP_F6, KP_F8, KP_F9, KP_F7,
988 KP_1, KP_3, KP_F11, KP_2,
989 KP_4, KP_6, KP_F12, KP_5,
990 KP_7, KP_9, KP_F13, KP_8,
991 KP_STAR, KP_HASH, KP_F14, KP_0,
992 KP_F5, KP_F15, KP_F16, KP_F10,
995 static const int kp_repeats[KP_ROWS * KP_COLS] = {
1005 static int kp_state = SCAN;
1006 static int kp_last_col_mask;
1007 static int kp_cur_row, kp_cur_col;
1008 static int kp_scancode;
1009 static int kp_stable;
1010 static int kp_repeat;
1011 static int kp_repeat_time;
1012 static int kp_force_time;
1013 static int kp_idle_time;
1015 static void kp_do_poll(void)
1017 unsigned int col_mask;
1022 if (kp_idle_time > 0) {
1023 kp_idle_time -= PHONE_CONSOLE_POLL_HZ;
1024 if (kp_idle_time <= 0)
1025 scancode_action(KP_IDLE);
1028 col_mask = kp_get_col_mask(KP_ROWS_MASK);
1029 if (col_mask == KP_COLS_MASK)
1030 break; /* nothing */
1031 kp_last_col_mask = col_mask;
1033 kp_state = SCAN_FILTER;
1037 col_mask = kp_get_col_mask(KP_ROWS_MASK);
1038 if (col_mask != kp_last_col_mask) {
1043 kp_stable += PHONE_CONSOLE_POLL_HZ;
1044 if (kp_stable < KP_STABLE_HZ)
1049 kp_state = SCAN_COL;
1051 (void)kp_get_col_mask(1 << kp_cur_row);
1055 col_mask = kp_get_col_mask(1 << kp_cur_row);
1056 if (col_mask == KP_COLS_MASK) {
1057 if (++kp_cur_row >= KP_ROWS) {
1061 kp_get_col_mask(1 << kp_cur_row);
1064 kp_last_col_mask = col_mask;
1066 kp_state = SCAN_COL_FILTER;
1069 case SCAN_COL_FILTER:
1070 col_mask = kp_get_col_mask(1 << kp_cur_row);
1071 if (col_mask != kp_last_col_mask || col_mask == KP_COLS_MASK) {
1076 kp_stable += PHONE_CONSOLE_POLL_HZ;
1077 if (kp_stable < KP_STABLE_HZ)
1080 for (col = 0; col < KP_COLS; col++)
1081 if ((col_mask & (1 << col)) == 0)
1085 kp_scancode = kp_scancodes[kp_cur_row * KP_COLS + kp_cur_col];
1086 kp_repeat = kp_repeats[kp_cur_row * KP_COLS + kp_cur_col];
1089 kp_repeat_time = KP_REPEAT_DELAY_HZ;
1090 kp_force_time = KP_FORCE_DELAY_HZ;
1092 scancode_action(kp_scancode);
1097 col_mask = kp_get_col_mask(1 << kp_cur_row);
1098 if (col_mask != kp_last_col_mask) {
1100 scancode_action(KP_RELEASE);
1101 kp_idle_time = KP_IDLE_DELAY_HZ;
1106 kp_repeat_time -= PHONE_CONSOLE_POLL_HZ;
1107 if (kp_repeat_time <= 0) {
1108 kp_repeat_time += KP_REPEAT_HZ;
1109 scancode_action(kp_scancode);
1113 if (kp_force_time > 0) {
1114 kp_force_time -= PHONE_CONSOLE_POLL_HZ;
1115 if (kp_force_time <= 0)
1116 scancode_action(KP_FORCE);
1123 /**************************************************************************************/
1125 int drv_phone_is_idle(void)
1127 return kp_state == SCAN;