lcd_console.c 5.1 KB

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