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()
543 			charlcd_gotoxy(lcd);  in handle_lcd_special_code()
559 		lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
566 		lcd->ops->write_cmd(lcd,  in handle_lcd_special_code()
568 			((lcd->ifwidth == 8) ? LCD_CMD_DATA_LEN_8BITS : 0) |  in handle_lcd_special_code()
573 		charlcd_backlight(lcd, !!(priv->flags & LCD_FLAG_L));  in handle_lcd_special_code()
578 static void charlcd_write_char(struct charlcd *lcd, char c)  in charlcd_write_char()  argument
580 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_write_char()
604 				if (priv->addr.x < lcd->bwidth)  in charlcd_write_char()
606 					lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT);  in charlcd_write_char()
610 			lcd->ops->write_data(lcd, ' ');  in charlcd_write_char()
612 			lcd->ops->write_cmd(lcd, LCD_CMD_SHIFT);  in charlcd_write_char()
616 			charlcd_clear_fast(lcd);  in charlcd_write_char()
623 			for (; priv->addr.x < lcd->bwidth; priv->addr.x++)  in charlcd_write_char()
624 				lcd->ops->write_data(lcd, ' ');  in charlcd_write_char()
626 			priv->addr.y = (priv->addr.y + 1) % lcd->height;  in charlcd_write_char()
627 			charlcd_gotoxy(lcd);  in charlcd_write_char()
632 			charlcd_gotoxy(lcd);  in charlcd_write_char()
636 			charlcd_print(lcd, ' ');  in charlcd_write_char()
640 			charlcd_print(lcd, c);  in charlcd_write_char()
654 			charlcd_clear_fast(lcd);  in charlcd_write_char()
658 			charlcd_home(lcd);  in charlcd_write_char()
665 			processed = handle_lcd_special_code(lcd);  in charlcd_write_char()
717 		charlcd_clear_display(&priv->lcd);  in charlcd_open()
746 static void charlcd_puts(struct charlcd *lcd, const char *s)  in charlcd_puts()  argument
759 		charlcd_write_char(lcd, *tmp);  in charlcd_puts()
764 static int charlcd_init(struct charlcd *lcd)  in charlcd_init()  argument
766 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_init()
769 	if (lcd->ops->backlight) {  in charlcd_init()
779 	ret = charlcd_init_display(lcd);  in charlcd_init()
786 	charlcd_puts(lcd, "\x1b[Lc\x1b[Lb\x1b[L*" CONFIG_PANEL_BOOT_MESSAGE);  in charlcd_init()
789 	charlcd_puts(lcd, "\x1b[Lc\x1b[Lb\x1b[L*Linux-" UTS_RELEASE "\n");  in charlcd_init()
793 	charlcd_home(lcd);  in charlcd_init()
800 	struct charlcd *lcd;  in charlcd_alloc()  local
808 	lcd = &priv->lcd;  in charlcd_alloc()
809 	lcd->ifwidth = 8;  in charlcd_alloc()
810 	lcd->bwidth = DEFAULT_LCD_BWIDTH;  in charlcd_alloc()
811 	lcd->hwidth = DEFAULT_LCD_HWIDTH;  in charlcd_alloc()
812 	lcd->drvdata = priv->drvdata;  in charlcd_alloc()
814 	return lcd;  in charlcd_alloc()
821 	struct charlcd *lcd = the_charlcd;  in panel_notify_sys()  local
825 		charlcd_puts(lcd,  in panel_notify_sys()
829 		charlcd_puts(lcd, "\x0cSystem Halted.\x1b[Lc\x1b[Lb\x1b[L+");  in panel_notify_sys()
832 		charlcd_puts(lcd, "\x0cPower off.\x1b[Lc\x1b[Lb\x1b[L+");  in panel_notify_sys()
846 int charlcd_register(struct charlcd *lcd)  in charlcd_register()  argument
850 	ret = charlcd_init(lcd);  in charlcd_register()
858 	the_charlcd = lcd;  in charlcd_register()
864 int charlcd_unregister(struct charlcd *lcd)  in charlcd_unregister()  argument
866 	struct charlcd_priv *priv = to_priv(lcd);  in charlcd_unregister()
869 	charlcd_puts(lcd, "\x0cLCD driver unloaded.\x1b[Lc\x1b[Lb\x1b[L-");  in charlcd_unregister()
872 	if (lcd->ops->backlight) {  in charlcd_unregister()
874 		priv->lcd.ops->backlight(&priv->lcd, 0);  in charlcd_unregister()