lcd_console.c 5.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2001-2015
  4. * DENX Software Engineering -- wd@denx.de
  5. * Compulab Ltd - http://compulab.co.il/
  6. * Bernecker & Rainer Industrieelektronik GmbH - http://www.br-automation.com
  7. */
  8. #include <common.h>
  9. #include <lcd.h>
  10. #include <serial.h>
  11. #include <video_font.h> /* Get font data, width and height */
  12. #if defined(CONFIG_LCD_LOGO)
  13. #include <bmp_logo.h>
  14. #endif
  15. static struct console_t cons;
  16. void lcd_set_col(short col)
  17. {
  18. cons.curr_col = col;
  19. }
  20. void lcd_set_row(short row)
  21. {
  22. cons.curr_row = row;
  23. }
  24. void lcd_position_cursor(unsigned col, unsigned row)
  25. {
  26. cons.curr_col = min_t(short, col, cons.cols - 1);
  27. cons.curr_row = min_t(short, row, cons.rows - 1);
  28. }
  29. int lcd_get_screen_rows(void)
  30. {
  31. return cons.rows;
  32. }
  33. int lcd_get_screen_columns(void)
  34. {
  35. return cons.cols;
  36. }
  37. static void lcd_putc_xy0(struct console_t *pcons, ushort x, ushort y, char c)
  38. {
  39. int fg_color = lcd_getfgcolor();
  40. int bg_color = lcd_getbgcolor();
  41. int i, row;
  42. fbptr_t *dst = (fbptr_t *)pcons->fbbase +
  43. y * pcons->lcdsizex +
  44. x;
  45. for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
  46. uchar bits = video_fontdata[c * VIDEO_FONT_HEIGHT + row];
  47. for (i = 0; i < VIDEO_FONT_WIDTH; ++i) {
  48. *dst++ = (bits & 0x80) ? fg_color : bg_color;
  49. bits <<= 1;
  50. }
  51. dst += (pcons->lcdsizex - VIDEO_FONT_WIDTH);
  52. }
  53. }
  54. static inline void console_setrow0(struct console_t *pcons, u32 row, int clr)
  55. {
  56. int i;
  57. fbptr_t *dst = (fbptr_t *)pcons->fbbase +
  58. row * VIDEO_FONT_HEIGHT *
  59. pcons->lcdsizex;
  60. for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
  61. *dst++ = clr;
  62. }
  63. static inline void console_moverow0(struct console_t *pcons,
  64. u32 rowdst, u32 rowsrc)
  65. {
  66. int i;
  67. fbptr_t *dst = (fbptr_t *)pcons->fbbase +
  68. rowdst * VIDEO_FONT_HEIGHT *
  69. pcons->lcdsizex;
  70. fbptr_t *src = (fbptr_t *)pcons->fbbase +
  71. rowsrc * VIDEO_FONT_HEIGHT *
  72. pcons->lcdsizex;
  73. for (i = 0; i < (VIDEO_FONT_HEIGHT * pcons->lcdsizex); i++)
  74. *dst++ = *src++;
  75. }
  76. static inline void console_back(void)
  77. {
  78. if (--cons.curr_col < 0) {
  79. cons.curr_col = cons.cols - 1;
  80. if (--cons.curr_row < 0)
  81. cons.curr_row = 0;
  82. }
  83. cons.fp_putc_xy(&cons,
  84. cons.curr_col * VIDEO_FONT_WIDTH,
  85. cons.curr_row * VIDEO_FONT_HEIGHT, ' ');
  86. }
  87. static inline void console_newline(void)
  88. {
  89. const int rows = CONFIG_CONSOLE_SCROLL_LINES;
  90. int bg_color = lcd_getbgcolor();
  91. int i;
  92. cons.curr_col = 0;
  93. /* Check if we need to scroll the terminal */
  94. if (++cons.curr_row >= cons.rows) {
  95. for (i = 0; i < cons.rows-rows; i++)
  96. cons.fp_console_moverow(&cons, i, i+rows);
  97. for (i = 0; i < rows; i++)
  98. cons.fp_console_setrow(&cons, cons.rows-i-1, bg_color);
  99. cons.curr_row -= rows;
  100. }
  101. lcd_sync();
  102. }
  103. void console_calc_rowcol(struct console_t *pcons, u32 sizex, u32 sizey)
  104. {
  105. pcons->cols = sizex / VIDEO_FONT_WIDTH;
  106. #if defined(CONFIG_LCD_LOGO) && !defined(CONFIG_LCD_INFO_BELOW_LOGO)
  107. pcons->rows = (pcons->lcdsizey - BMP_LOGO_HEIGHT);
  108. pcons->rows /= VIDEO_FONT_HEIGHT;
  109. #else
  110. pcons->rows = sizey / VIDEO_FONT_HEIGHT;
  111. #endif
  112. }
  113. void __weak lcd_init_console_rot(struct console_t *pcons)
  114. {
  115. return;
  116. }
  117. void lcd_init_console(void *address, int vl_cols, int vl_rows, int vl_rot)
  118. {
  119. memset(&cons, 0, sizeof(cons));
  120. cons.fbbase = address;
  121. cons.lcdsizex = vl_cols;
  122. cons.lcdsizey = vl_rows;
  123. cons.lcdrot = vl_rot;
  124. cons.fp_putc_xy = &lcd_putc_xy0;
  125. cons.fp_console_moverow = &console_moverow0;
  126. cons.fp_console_setrow = &console_setrow0;
  127. console_calc_rowcol(&cons, cons.lcdsizex, cons.lcdsizey);
  128. lcd_init_console_rot(&cons);
  129. debug("lcd_console: have %d/%d col/rws on scr %dx%d (%d deg rotated)\n",
  130. cons.cols, cons.rows, cons.lcdsizex, cons.lcdsizey, vl_rot);
  131. }
  132. void lcd_putc(const char c)
  133. {
  134. if (!lcd_is_enabled) {
  135. serial_putc(c);
  136. return;
  137. }
  138. switch (c) {
  139. case '\r':
  140. cons.curr_col = 0;
  141. return;
  142. case '\n':
  143. console_newline();
  144. return;
  145. case '\t': /* Tab (8 chars alignment) */
  146. cons.curr_col += 8;
  147. cons.curr_col &= ~7;
  148. if (cons.curr_col >= cons.cols)
  149. console_newline();
  150. return;
  151. case '\b':
  152. console_back();
  153. return;
  154. default:
  155. cons.fp_putc_xy(&cons,
  156. cons.curr_col * VIDEO_FONT_WIDTH,
  157. cons.curr_row * VIDEO_FONT_HEIGHT, c);
  158. if (++cons.curr_col >= cons.cols)
  159. console_newline();
  160. }
  161. }
  162. void lcd_puts(const char *s)
  163. {
  164. if (!lcd_is_enabled) {
  165. serial_puts(s);
  166. return;
  167. }
  168. while (*s)
  169. lcd_putc(*s++);
  170. lcd_sync();
  171. }
  172. void lcd_printf(const char *fmt, ...)
  173. {
  174. va_list args;
  175. char buf[CONFIG_SYS_PBSIZE];
  176. va_start(args, fmt);
  177. vsprintf(buf, fmt, args);
  178. va_end(args);
  179. lcd_puts(buf);
  180. }
  181. static int do_lcd_setcursor(cmd_tbl_t *cmdtp, int flag, int argc,
  182. char *const argv[])
  183. {
  184. unsigned int col, row;
  185. if (argc != 3)
  186. return CMD_RET_USAGE;
  187. col = simple_strtoul(argv[1], NULL, 10);
  188. row = simple_strtoul(argv[2], NULL, 10);
  189. lcd_position_cursor(col, row);
  190. return 0;
  191. }
  192. static int do_lcd_puts(cmd_tbl_t *cmdtp, int flag, int argc,
  193. char *const argv[])
  194. {
  195. if (argc != 2)
  196. return CMD_RET_USAGE;
  197. lcd_puts(argv[1]);
  198. return 0;
  199. }
  200. U_BOOT_CMD(
  201. setcurs, 3, 1, do_lcd_setcursor,
  202. "set cursor position within screen",
  203. " <col> <row> in character"
  204. );
  205. U_BOOT_CMD(
  206. lcdputs, 2, 1, do_lcd_puts,
  207. "print string on lcd-framebuffer",
  208. " <string>"
  209. );