68 	struct charlcd lcd;  member
94 #define to_priv(p)	container_of(p, struct charlcd_priv, lcd)
106 static void charlcd_backlight(struct charlcd *lcd, int on)  in charlcd_backlight()  argument
108 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_backlight()
110 	if (!lcd->ops->backlight)  in charlcd_backlight()
115 		lcd->ops->backlight(lcd, on);  in charlcd_backlight()
129 			priv->lcd.ops->backlight(&priv->lcd, 0);  in charlcd_bl_off()
135 void charlcd_poke(struct charlcd *lcd)  in charlcd_poke()  argument
137 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_poke()
139 	if (!lcd->ops->backlight)  in charlcd_poke()
146 		lcd->ops->backlight(lcd, 1);  in charlcd_poke()
153 static void charlcd_gotoxy(struct charlcd *lcd)  in charlcd_gotoxy()  argument
155 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_gotoxy()
162 	addr = priv->addr.x < lcd->bwidth ? priv->addr.x & (lcd->hwidth - 1)  in charlcd_gotoxy()
163 					  : lcd->bwidth - 1;  in charlcd_gotoxy()
165 		addr += lcd->hwidth;  in charlcd_gotoxy()
167 		addr += lcd->bwidth;  in charlcd_gotoxy()
168 	lcd->ops->write_cmd(lcd, LCD_CMD_SET_DDRAM_ADDR | addr);  in charlcd_gotoxy()
171 static void charlcd_home(struct charlcd *lcd)  in charlcd_home()  argument
173 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_home()
177 	charlcd_gotoxy(lcd);  in charlcd_home()
180 static void charlcd_print(struct charlcd *lcd, char c)  in charlcd_print()  argument
182 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_print()
184 	if (priv->addr.x < lcd->bwidth) {  in charlcd_print()
185 		if (lcd->char_conv)  in charlcd_print()
186 			c = lcd->char_conv[(unsigned char)c];  in charlcd_print()
187 		lcd->ops->write_data(lcd, c);  in charlcd_print()
191 		if (priv->addr.x == lcd->bwidth)  in charlcd_print()
192 			charlcd_gotoxy(lcd);  in charlcd_print()
196 static void charlcd_clear_fast(struct charlcd *lcd)  in charlcd_clear_fast()  argument
200 	charlcd_home(lcd);  in charlcd_clear_fast()
202 	if (lcd->ops->clear_fast)  in charlcd_clear_fast()
203 		lcd->ops->clear_fast(lcd);  in charlcd_clear_fast()
205 		for (pos = 0; pos < min(2, lcd->height) * lcd->hwidth; pos++)  in charlcd_clear_fast()
206 			lcd->ops->write_data(lcd, ' ');  in charlcd_clear_fast()
208 	charlcd_home(lcd);  in charlcd_clear_fast()
212 static void charlcd_clear_display(struct charlcd *lcd)  in charlcd_clear_display()  argument
214 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_clear_display()
216 	lcd->ops->write_cmd(lcd, LCD_CMD_DISPLAY_CLEAR);  in charlcd_clear_display()
223 static int charlcd_init_display(struct charlcd *lcd)  in charlcd_init_display()  argument
225 	void (*write_cmd_raw)(struct charlcd *lcd, int cmd);  in charlcd_init_display()
226 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_init_display()
229 	if (lcd->ifwidth != 4 && lcd->ifwidth != 8)  in charlcd_init_display()
232 	priv->flags = ((lcd->height > 1) ? LCD_FLAG_N : 0) | LCD_FLAG_D |  in charlcd_init_display()
242 	if (lcd->ifwidth == 4) {  in charlcd_init_display()
244 		write_cmd_raw = lcd->ops->write_cmd_raw4;  in charlcd_init_display()
246 		write_cmd_raw = lcd->ops->write_cmd;  in charlcd_init_display()
248 	write_cmd_raw(lcd, init);  in charlcd_init_display()
250 	write_cmd_raw(lcd, init);  in charlcd_init_display()
252 	write_cmd_raw(lcd, init);  in charlcd_init_display()
255 	if (lcd->ifwidth == 4) {  in charlcd_init_display()
257 		lcd->ops->write_cmd_raw4(lcd, LCD_CMD_FUNCTION_SET >> 4);  in charlcd_init_display()
262 	lcd->ops->write_cmd(lcd,  in charlcd_init_display()
264 		((lcd->ifwidth == 8) ? LCD_CMD_DATA_LEN_8BITS : 0) |  in charlcd_init_display()
270 	lcd->ops->write_cmd(lcd, LCD_CMD_DISPLAY_CTRL);  in charlcd_init_display()
273 	lcd->ops->write_cmd(lcd,  in charlcd_init_display()
279 	charlcd_backlight(lcd, (priv->flags & LCD_FLAG_L) ? 1 : 0);  in charlcd_init_display()
284 	lcd->ops->write_cmd(lcd, LCD_CMD_ENTRY_MODE | LCD_CMD_CURSOR_INC);  in charlcd_init_display()
286 	charlcd_clear_display(lcd);  in charlcd_init_display()
370 static inline int handle_lcd_special_code(struct charlcd *lcd)  in handle_lcd_special_code()  argument
372 	struct charlcd_priv *priv = to_priv(lcd);  in handle_lcd_special_code()
416 		charlcd_poke(lcd);  in handle_lcd_special_code()
438 			if (priv->addr.x < lcd->bwidth)  in handle_lcd_special_code()
439 				lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT);  in handle_lcd_special_code()
445 		if (priv->addr.x < lcd->width) {  in handle_lcd_special_code()
447 			if (priv->addr.x < (lcd->bwidth - 1))  in handle_lcd_special_code()
448 				lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
455 		lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT | LCD_CMD_DISPLAY_SHIFT);  in handle_lcd_special_code()
459 		lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
467 		for (x = priv->addr.x; x < lcd->bwidth; x++)  in handle_lcd_special_code()
468 			lcd->ops->write_data(lcd, ' ');  in handle_lcd_special_code()
471 		charlcd_gotoxy(lcd);  in handle_lcd_special_code()
476 		charlcd_init_display(lcd);  in handle_lcd_special_code()
530 		lcd->ops->write_cmd(lcd, LCD_CMD_SET_CGRAM_ADDR | (cgaddr * 8));  in handle_lcd_special_code()
532 			lcd->ops->write_data(lcd, cgbytes[addr]);  in handle_lcd_special_code()
535 		charlcd_gotoxy(lcd);  in handle_lcd_special_code()
546 			charlcd_gotoxy(lcd);  in handle_lcd_special_code()
562 		lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
569 		lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
571 			((lcd->ifwidth == 8) ? LCD_CMD_DATA_LEN_8BITS : 0) |  in handle_lcd_special_code()
576 		charlcd_backlight(lcd, !!(priv->flags & LCD_FLAG_L));  in handle_lcd_special_code()
581 static void charlcd_write_char(struct charlcd *lcd, char c)  in charlcd_write_char()  argument
583 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_write_char()
607 				if (priv->addr.x < lcd->bwidth)  in charlcd_write_char()
609 					lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT);  in charlcd_write_char()
613 			lcd->ops->write_data(lcd, ' ');  in charlcd_write_char()
615 			lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT);  in charlcd_write_char()
619 			charlcd_clear_fast(lcd);  in charlcd_write_char()
626 			for (; priv->addr.x < lcd->bwidth; priv->addr.x++)  in charlcd_write_char()
627 				lcd->ops->write_data(lcd, ' ');  in charlcd_write_char()
629 			priv->addr.y = (priv->addr.y + 1) % lcd->height;  in charlcd_write_char()
630 			charlcd_gotoxy(lcd);  in charlcd_write_char()
635 			charlcd_gotoxy(lcd);  in charlcd_write_char()
639 			charlcd_print(lcd, ' ');  in charlcd_write_char()
643 			charlcd_print(lcd, c);  in charlcd_write_char()
657 			charlcd_clear_fast(lcd);  in charlcd_write_char()
661 			charlcd_home(lcd);  in charlcd_write_char()
668 			processed = handle_lcd_special_code(lcd);  in charlcd_write_char()
720 		charlcd_clear_display(&priv->lcd);  in charlcd_open()
749 static void charlcd_puts(struct charlcd *lcd, const char *s)  in charlcd_puts()  argument
762 		charlcd_write_char(lcd, *tmp);  in charlcd_puts()
767 static int charlcd_init(struct charlcd *lcd)  in charlcd_init()  argument
769 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_init()
772 	if (lcd->ops->backlight) {  in charlcd_init()
782 	ret = charlcd_init_display(lcd);  in charlcd_init()
789 	charlcd_puts(lcd, "\x1b[Lc\x1b[Lb\x1b[L*" CONFIG_PANEL_BOOT_MESSAGE);  in charlcd_init()
792 	charlcd_puts(lcd, "\x1b[Lc\x1b[Lb\x1b[L*Linux-" UTS_RELEASE "\n");  in charlcd_init()
796 	charlcd_home(lcd);  in charlcd_init()
803 	struct charlcd *lcd;  in charlcd_alloc()  local
811 	lcd = &priv->lcd;  in charlcd_alloc()
812 	lcd->ifwidth = 8;  in charlcd_alloc()
813 	lcd->bwidth = DEFAULT_LCD_BWIDTH;  in charlcd_alloc()
814 	lcd->hwidth = DEFAULT_LCD_HWIDTH;  in charlcd_alloc()
815 	lcd->drvdata = priv->drvdata;  in charlcd_alloc()
817 	return lcd;  in charlcd_alloc()
824 	struct charlcd *lcd = the_charlcd;  in panel_notify_sys()  local
828 		charlcd_puts(lcd,  in panel_notify_sys()
832 		charlcd_puts(lcd, "\x0cSystem Halted.\x1b[Lc\x1b[Lb\x1b[L+");  in panel_notify_sys()
835 		charlcd_puts(lcd, "\x0cPower off.\x1b[Lc\x1b[Lb\x1b[L+");  in panel_notify_sys()
849 int charlcd_register(struct charlcd *lcd)  in charlcd_register()  argument
853 	ret = charlcd_init(lcd);  in charlcd_register()
861 	the_charlcd = lcd;  in charlcd_register()
867 int charlcd_unregister(struct charlcd *lcd)  in charlcd_unregister()  argument
869 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_unregister()
872 	charlcd_puts(lcd, "\x0cLCD driver unloaded.\x1b[Lc\x1b[Lb\x1b[L-");  in charlcd_unregister()
875 	if (lcd->ops->backlight) {  in charlcd_unregister()
877 		priv->lcd.ops->backlight(&priv->lcd, 0);  in charlcd_unregister()