Commit | Line | Data |
---|---|---|
2c8304d3 HS |
1 | /* |
2 | * Common code for AUO-K190X framebuffer drivers | |
3 | * | |
4 | * Copyright (C) 2012 Heiko Stuebner <heiko@sntech.de> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 as | |
8 | * published by the Free Software Foundation. | |
9 | */ | |
10 | ||
11 | #include <linux/module.h> | |
12 | #include <linux/kernel.h> | |
13 | #include <linux/gpio.h> | |
14 | #include <linux/pm_runtime.h> | |
15 | #include <linux/fb.h> | |
16 | #include <linux/delay.h> | |
17 | #include <linux/uaccess.h> | |
18 | #include <linux/vmalloc.h> | |
19 | #include <linux/regulator/consumer.h> | |
20 | ||
21 | #include <video/auo_k190xfb.h> | |
22 | ||
23 | #include "auo_k190x.h" | |
24 | ||
25 | struct panel_info { | |
26 | int w; | |
27 | int h; | |
28 | }; | |
29 | ||
30 | /* table of panel specific parameters to be indexed into by the board drivers */ | |
31 | static struct panel_info panel_table[] = { | |
32 | /* standard 6" */ | |
33 | [AUOK190X_RESOLUTION_800_600] = { | |
34 | .w = 800, | |
35 | .h = 600, | |
36 | }, | |
37 | /* standard 9" */ | |
38 | [AUOK190X_RESOLUTION_1024_768] = { | |
39 | .w = 1024, | |
40 | .h = 768, | |
41 | }, | |
42 | }; | |
43 | ||
44 | /* | |
45 | * private I80 interface to the board driver | |
46 | */ | |
47 | ||
48 | static void auok190x_issue_data(struct auok190xfb_par *par, u16 data) | |
49 | { | |
50 | par->board->set_ctl(par, AUOK190X_I80_WR, 0); | |
51 | par->board->set_hdb(par, data); | |
52 | par->board->set_ctl(par, AUOK190X_I80_WR, 1); | |
53 | } | |
54 | ||
55 | static void auok190x_issue_cmd(struct auok190xfb_par *par, u16 data) | |
56 | { | |
57 | par->board->set_ctl(par, AUOK190X_I80_DC, 0); | |
58 | auok190x_issue_data(par, data); | |
59 | par->board->set_ctl(par, AUOK190X_I80_DC, 1); | |
60 | } | |
61 | ||
62 | static int auok190x_issue_pixels(struct auok190xfb_par *par, int size, | |
63 | u16 *data) | |
64 | { | |
65 | struct device *dev = par->info->device; | |
66 | int i; | |
67 | u16 tmp; | |
68 | ||
69 | if (size & 3) { | |
70 | dev_err(dev, "issue_pixels: size %d must be a multiple of 4\n", | |
71 | size); | |
72 | return -EINVAL; | |
73 | } | |
74 | ||
75 | for (i = 0; i < (size >> 1); i++) { | |
76 | par->board->set_ctl(par, AUOK190X_I80_WR, 0); | |
77 | ||
78 | /* simple reduction of 8bit staticgray to 4bit gray | |
79 | * combines 4 * 4bit pixel values into a 16bit value | |
80 | */ | |
81 | tmp = (data[2*i] & 0xF0) >> 4; | |
82 | tmp |= (data[2*i] & 0xF000) >> 8; | |
83 | tmp |= (data[2*i+1] & 0xF0) << 4; | |
84 | tmp |= (data[2*i+1] & 0xF000); | |
85 | ||
86 | par->board->set_hdb(par, tmp); | |
87 | par->board->set_ctl(par, AUOK190X_I80_WR, 1); | |
88 | } | |
89 | ||
90 | return 0; | |
91 | } | |
92 | ||
93 | static u16 auok190x_read_data(struct auok190xfb_par *par) | |
94 | { | |
95 | u16 data; | |
96 | ||
97 | par->board->set_ctl(par, AUOK190X_I80_OE, 0); | |
98 | data = par->board->get_hdb(par); | |
99 | par->board->set_ctl(par, AUOK190X_I80_OE, 1); | |
100 | ||
101 | return data; | |
102 | } | |
103 | ||
104 | /* | |
105 | * Command interface for the controller drivers | |
106 | */ | |
107 | ||
108 | void auok190x_send_command_nowait(struct auok190xfb_par *par, u16 data) | |
109 | { | |
110 | par->board->set_ctl(par, AUOK190X_I80_CS, 0); | |
111 | auok190x_issue_cmd(par, data); | |
112 | par->board->set_ctl(par, AUOK190X_I80_CS, 1); | |
113 | } | |
114 | EXPORT_SYMBOL_GPL(auok190x_send_command_nowait); | |
115 | ||
116 | void auok190x_send_cmdargs_nowait(struct auok190xfb_par *par, u16 cmd, | |
117 | int argc, u16 *argv) | |
118 | { | |
119 | int i; | |
120 | ||
121 | par->board->set_ctl(par, AUOK190X_I80_CS, 0); | |
122 | auok190x_issue_cmd(par, cmd); | |
123 | ||
124 | for (i = 0; i < argc; i++) | |
125 | auok190x_issue_data(par, argv[i]); | |
126 | par->board->set_ctl(par, AUOK190X_I80_CS, 1); | |
127 | } | |
128 | EXPORT_SYMBOL_GPL(auok190x_send_cmdargs_nowait); | |
129 | ||
130 | int auok190x_send_command(struct auok190xfb_par *par, u16 data) | |
131 | { | |
132 | int ret; | |
133 | ||
134 | ret = par->board->wait_for_rdy(par); | |
135 | if (ret) | |
136 | return ret; | |
137 | ||
138 | auok190x_send_command_nowait(par, data); | |
139 | return 0; | |
140 | } | |
141 | EXPORT_SYMBOL_GPL(auok190x_send_command); | |
142 | ||
143 | int auok190x_send_cmdargs(struct auok190xfb_par *par, u16 cmd, | |
144 | int argc, u16 *argv) | |
145 | { | |
146 | int ret; | |
147 | ||
148 | ret = par->board->wait_for_rdy(par); | |
149 | if (ret) | |
150 | return ret; | |
151 | ||
152 | auok190x_send_cmdargs_nowait(par, cmd, argc, argv); | |
153 | return 0; | |
154 | } | |
155 | EXPORT_SYMBOL_GPL(auok190x_send_cmdargs); | |
156 | ||
157 | int auok190x_read_cmdargs(struct auok190xfb_par *par, u16 cmd, | |
158 | int argc, u16 *argv) | |
159 | { | |
160 | int i, ret; | |
161 | ||
162 | ret = par->board->wait_for_rdy(par); | |
163 | if (ret) | |
164 | return ret; | |
165 | ||
166 | par->board->set_ctl(par, AUOK190X_I80_CS, 0); | |
167 | auok190x_issue_cmd(par, cmd); | |
168 | ||
169 | for (i = 0; i < argc; i++) | |
170 | argv[i] = auok190x_read_data(par); | |
171 | par->board->set_ctl(par, AUOK190X_I80_CS, 1); | |
172 | ||
173 | return 0; | |
174 | } | |
175 | EXPORT_SYMBOL_GPL(auok190x_read_cmdargs); | |
176 | ||
177 | void auok190x_send_cmdargs_pixels_nowait(struct auok190xfb_par *par, u16 cmd, | |
178 | int argc, u16 *argv, int size, u16 *data) | |
179 | { | |
180 | int i; | |
181 | ||
182 | par->board->set_ctl(par, AUOK190X_I80_CS, 0); | |
183 | ||
184 | auok190x_issue_cmd(par, cmd); | |
185 | ||
186 | for (i = 0; i < argc; i++) | |
187 | auok190x_issue_data(par, argv[i]); | |
188 | ||
189 | auok190x_issue_pixels(par, size, data); | |
190 | ||
191 | par->board->set_ctl(par, AUOK190X_I80_CS, 1); | |
192 | } | |
193 | EXPORT_SYMBOL_GPL(auok190x_send_cmdargs_pixels_nowait); | |
194 | ||
195 | int auok190x_send_cmdargs_pixels(struct auok190xfb_par *par, u16 cmd, | |
196 | int argc, u16 *argv, int size, u16 *data) | |
197 | { | |
198 | int ret; | |
199 | ||
200 | ret = par->board->wait_for_rdy(par); | |
201 | if (ret) | |
202 | return ret; | |
203 | ||
204 | auok190x_send_cmdargs_pixels_nowait(par, cmd, argc, argv, size, data); | |
205 | ||
206 | return 0; | |
207 | } | |
208 | EXPORT_SYMBOL_GPL(auok190x_send_cmdargs_pixels); | |
209 | ||
210 | /* | |
211 | * fbdefio callbacks - common on both controllers. | |
212 | */ | |
213 | ||
214 | static void auok190xfb_dpy_first_io(struct fb_info *info) | |
215 | { | |
216 | /* tell runtime-pm that we wish to use the device in a short time */ | |
217 | pm_runtime_get(info->device); | |
218 | } | |
219 | ||
220 | /* this is called back from the deferred io workqueue */ | |
221 | static void auok190xfb_dpy_deferred_io(struct fb_info *info, | |
222 | struct list_head *pagelist) | |
223 | { | |
224 | struct fb_deferred_io *fbdefio = info->fbdefio; | |
225 | struct auok190xfb_par *par = info->par; | |
226 | u16 yres = info->var.yres; | |
227 | u16 xres = info->var.xres; | |
228 | u16 y1 = 0, h = 0; | |
229 | int prev_index = -1; | |
230 | struct page *cur; | |
231 | int h_inc; | |
232 | int threshold; | |
233 | ||
234 | if (!list_empty(pagelist)) | |
235 | /* the device resume should've been requested through first_io, | |
236 | * if the resume did not finish until now, wait for it. | |
237 | */ | |
238 | pm_runtime_barrier(info->device); | |
239 | else | |
240 | /* We reached this via the fsync or some other way. | |
241 | * In either case the first_io function did not run, | |
242 | * so we runtime_resume the device here synchronously. | |
243 | */ | |
244 | pm_runtime_get_sync(info->device); | |
245 | ||
246 | /* Do a full screen update every n updates to prevent | |
247 | * excessive darkening of the Sipix display. | |
248 | * If we do this, there is no need to walk the pages. | |
249 | */ | |
250 | if (par->need_refresh(par)) { | |
251 | par->update_all(par); | |
252 | goto out; | |
253 | } | |
254 | ||
255 | /* height increment is fixed per page */ | |
256 | h_inc = DIV_ROUND_UP(PAGE_SIZE , xres); | |
257 | ||
258 | /* calculate number of pages from pixel height */ | |
259 | threshold = par->consecutive_threshold / h_inc; | |
260 | if (threshold < 1) | |
261 | threshold = 1; | |
262 | ||
263 | /* walk the written page list and swizzle the data */ | |
264 | list_for_each_entry(cur, &fbdefio->pagelist, lru) { | |
265 | if (prev_index < 0) { | |
266 | /* just starting so assign first page */ | |
267 | y1 = (cur->index << PAGE_SHIFT) / xres; | |
268 | h = h_inc; | |
269 | } else if ((cur->index - prev_index) <= threshold) { | |
270 | /* page is within our threshold for single updates */ | |
271 | h += h_inc * (cur->index - prev_index); | |
272 | } else { | |
273 | /* page not consecutive, issue previous update first */ | |
274 | par->update_partial(par, y1, y1 + h); | |
275 | ||
276 | /* start over with our non consecutive page */ | |
277 | y1 = (cur->index << PAGE_SHIFT) / xres; | |
278 | h = h_inc; | |
279 | } | |
280 | prev_index = cur->index; | |
281 | } | |
282 | ||
283 | /* if we still have any pages to update we do so now */ | |
284 | if (h >= yres) | |
285 | /* its a full screen update, just do it */ | |
286 | par->update_all(par); | |
287 | else | |
288 | par->update_partial(par, y1, min((u16) (y1 + h), yres)); | |
289 | ||
290 | out: | |
291 | pm_runtime_mark_last_busy(info->device); | |
292 | pm_runtime_put_autosuspend(info->device); | |
293 | } | |
294 | ||
295 | /* | |
296 | * framebuffer operations | |
297 | */ | |
298 | ||
299 | /* | |
300 | * this is the slow path from userspace. they can seek and write to | |
301 | * the fb. it's inefficient to do anything less than a full screen draw | |
302 | */ | |
303 | static ssize_t auok190xfb_write(struct fb_info *info, const char __user *buf, | |
304 | size_t count, loff_t *ppos) | |
305 | { | |
306 | struct auok190xfb_par *par = info->par; | |
307 | unsigned long p = *ppos; | |
308 | void *dst; | |
309 | int err = 0; | |
310 | unsigned long total_size; | |
311 | ||
312 | if (info->state != FBINFO_STATE_RUNNING) | |
313 | return -EPERM; | |
314 | ||
315 | total_size = info->fix.smem_len; | |
316 | ||
317 | if (p > total_size) | |
318 | return -EFBIG; | |
319 | ||
320 | if (count > total_size) { | |
321 | err = -EFBIG; | |
322 | count = total_size; | |
323 | } | |
324 | ||
325 | if (count + p > total_size) { | |
326 | if (!err) | |
327 | err = -ENOSPC; | |
328 | ||
329 | count = total_size - p; | |
330 | } | |
331 | ||
332 | dst = (void *)(info->screen_base + p); | |
333 | ||
334 | if (copy_from_user(dst, buf, count)) | |
335 | err = -EFAULT; | |
336 | ||
337 | if (!err) | |
338 | *ppos += count; | |
339 | ||
340 | par->update_all(par); | |
341 | ||
342 | return (err) ? err : count; | |
343 | } | |
344 | ||
345 | static void auok190xfb_fillrect(struct fb_info *info, | |
346 | const struct fb_fillrect *rect) | |
347 | { | |
348 | struct auok190xfb_par *par = info->par; | |
349 | ||
350 | sys_fillrect(info, rect); | |
351 | ||
352 | par->update_all(par); | |
353 | } | |
354 | ||
355 | static void auok190xfb_copyarea(struct fb_info *info, | |
356 | const struct fb_copyarea *area) | |
357 | { | |
358 | struct auok190xfb_par *par = info->par; | |
359 | ||
360 | sys_copyarea(info, area); | |
361 | ||
362 | par->update_all(par); | |
363 | } | |
364 | ||
365 | static void auok190xfb_imageblit(struct fb_info *info, | |
366 | const struct fb_image *image) | |
367 | { | |
368 | struct auok190xfb_par *par = info->par; | |
369 | ||
370 | sys_imageblit(info, image); | |
371 | ||
372 | par->update_all(par); | |
373 | } | |
374 | ||
375 | static int auok190xfb_check_var(struct fb_var_screeninfo *var, | |
376 | struct fb_info *info) | |
377 | { | |
378 | if (info->var.xres != var->xres || info->var.yres != var->yres || | |
379 | info->var.xres_virtual != var->xres_virtual || | |
380 | info->var.yres_virtual != var->yres_virtual) { | |
381 | pr_info("%s: Resolution not supported: X%u x Y%u\n", | |
382 | __func__, var->xres, var->yres); | |
383 | return -EINVAL; | |
384 | } | |
385 | ||
386 | /* | |
387 | * Memory limit | |
388 | */ | |
389 | ||
390 | if ((info->fix.line_length * var->yres_virtual) > info->fix.smem_len) { | |
391 | pr_info("%s: Memory Limit requested yres_virtual = %u\n", | |
392 | __func__, var->yres_virtual); | |
393 | return -ENOMEM; | |
394 | } | |
395 | ||
396 | return 0; | |
397 | } | |
398 | ||
399 | static struct fb_ops auok190xfb_ops = { | |
400 | .owner = THIS_MODULE, | |
401 | .fb_read = fb_sys_read, | |
402 | .fb_write = auok190xfb_write, | |
403 | .fb_fillrect = auok190xfb_fillrect, | |
404 | .fb_copyarea = auok190xfb_copyarea, | |
405 | .fb_imageblit = auok190xfb_imageblit, | |
406 | .fb_check_var = auok190xfb_check_var, | |
407 | }; | |
408 | ||
409 | /* | |
410 | * Controller-functions common to both K1900 and K1901 | |
411 | */ | |
412 | ||
413 | static int auok190x_read_temperature(struct auok190xfb_par *par) | |
414 | { | |
415 | struct device *dev = par->info->device; | |
416 | u16 data[4]; | |
417 | int temp; | |
418 | ||
419 | pm_runtime_get_sync(dev); | |
420 | ||
421 | mutex_lock(&(par->io_lock)); | |
422 | ||
423 | auok190x_read_cmdargs(par, AUOK190X_CMD_READ_VERSION, 4, data); | |
424 | ||
425 | mutex_unlock(&(par->io_lock)); | |
426 | ||
427 | pm_runtime_mark_last_busy(dev); | |
428 | pm_runtime_put_autosuspend(dev); | |
429 | ||
430 | /* sanitize and split of half-degrees for now */ | |
431 | temp = ((data[0] & AUOK190X_VERSION_TEMP_MASK) >> 1); | |
432 | ||
433 | /* handle positive and negative temperatures */ | |
434 | if (temp >= 201) | |
435 | return (255 - temp + 1) * (-1); | |
436 | else | |
437 | return temp; | |
438 | } | |
439 | ||
440 | static void auok190x_identify(struct auok190xfb_par *par) | |
441 | { | |
442 | struct device *dev = par->info->device; | |
443 | u16 data[4]; | |
444 | ||
445 | pm_runtime_get_sync(dev); | |
446 | ||
447 | mutex_lock(&(par->io_lock)); | |
448 | ||
449 | auok190x_read_cmdargs(par, AUOK190X_CMD_READ_VERSION, 4, data); | |
450 | ||
451 | mutex_unlock(&(par->io_lock)); | |
452 | ||
453 | par->epd_type = data[1] & AUOK190X_VERSION_TEMP_MASK; | |
454 | ||
455 | par->panel_size_int = AUOK190X_VERSION_SIZE_INT(data[2]); | |
456 | par->panel_size_float = AUOK190X_VERSION_SIZE_FLOAT(data[2]); | |
457 | par->panel_model = AUOK190X_VERSION_MODEL(data[2]); | |
458 | ||
459 | par->tcon_version = AUOK190X_VERSION_TCON(data[3]); | |
460 | par->lut_version = AUOK190X_VERSION_LUT(data[3]); | |
461 | ||
462 | dev_dbg(dev, "panel %d.%din, model 0x%x, EPD 0x%x TCON-rev 0x%x, LUT-rev 0x%x", | |
463 | par->panel_size_int, par->panel_size_float, par->panel_model, | |
464 | par->epd_type, par->tcon_version, par->lut_version); | |
465 | ||
466 | pm_runtime_mark_last_busy(dev); | |
467 | pm_runtime_put_autosuspend(dev); | |
468 | } | |
469 | ||
470 | /* | |
471 | * Sysfs functions | |
472 | */ | |
473 | ||
474 | static ssize_t update_mode_show(struct device *dev, | |
475 | struct device_attribute *attr, char *buf) | |
476 | { | |
477 | struct fb_info *info = dev_get_drvdata(dev); | |
478 | struct auok190xfb_par *par = info->par; | |
479 | ||
480 | return sprintf(buf, "%d\n", par->update_mode); | |
481 | } | |
482 | ||
483 | static ssize_t update_mode_store(struct device *dev, | |
484 | struct device_attribute *attr, | |
485 | const char *buf, size_t count) | |
486 | { | |
487 | struct fb_info *info = dev_get_drvdata(dev); | |
488 | struct auok190xfb_par *par = info->par; | |
489 | int mode, ret; | |
490 | ||
491 | ret = kstrtoint(buf, 10, &mode); | |
492 | if (ret) | |
493 | return ret; | |
494 | ||
495 | par->update_mode = mode; | |
496 | ||
497 | /* if we enter a better mode, do a full update */ | |
498 | if (par->last_mode > 1 && mode < par->last_mode) | |
499 | par->update_all(par); | |
500 | ||
501 | return count; | |
502 | } | |
503 | ||
504 | static ssize_t flash_show(struct device *dev, struct device_attribute *attr, | |
505 | char *buf) | |
506 | { | |
507 | struct fb_info *info = dev_get_drvdata(dev); | |
508 | struct auok190xfb_par *par = info->par; | |
509 | ||
510 | return sprintf(buf, "%d\n", par->flash); | |
511 | } | |
512 | ||
513 | static ssize_t flash_store(struct device *dev, struct device_attribute *attr, | |
514 | const char *buf, size_t count) | |
515 | { | |
516 | struct fb_info *info = dev_get_drvdata(dev); | |
517 | struct auok190xfb_par *par = info->par; | |
518 | int flash, ret; | |
519 | ||
520 | ret = kstrtoint(buf, 10, &flash); | |
521 | if (ret) | |
522 | return ret; | |
523 | ||
524 | if (flash > 0) | |
525 | par->flash = 1; | |
526 | else | |
527 | par->flash = 0; | |
528 | ||
529 | return count; | |
530 | } | |
531 | ||
532 | static ssize_t temp_show(struct device *dev, struct device_attribute *attr, | |
533 | char *buf) | |
534 | { | |
535 | struct fb_info *info = dev_get_drvdata(dev); | |
536 | struct auok190xfb_par *par = info->par; | |
537 | int temp; | |
538 | ||
539 | temp = auok190x_read_temperature(par); | |
540 | return sprintf(buf, "%d\n", temp); | |
541 | } | |
542 | ||
543 | static DEVICE_ATTR(update_mode, 0644, update_mode_show, update_mode_store); | |
544 | static DEVICE_ATTR(flash, 0644, flash_show, flash_store); | |
545 | static DEVICE_ATTR(temp, 0644, temp_show, NULL); | |
546 | ||
547 | static struct attribute *auok190x_attributes[] = { | |
548 | &dev_attr_update_mode.attr, | |
549 | &dev_attr_flash.attr, | |
550 | &dev_attr_temp.attr, | |
551 | NULL | |
552 | }; | |
553 | ||
554 | static const struct attribute_group auok190x_attr_group = { | |
555 | .attrs = auok190x_attributes, | |
556 | }; | |
557 | ||
558 | static int auok190x_power(struct auok190xfb_par *par, bool on) | |
559 | { | |
560 | struct auok190x_board *board = par->board; | |
561 | int ret; | |
562 | ||
563 | if (on) { | |
564 | /* We should maintain POWER up for at least 80ms before set | |
565 | * RST_N and SLP_N to high (TCON spec 20100803_v35 p59) | |
566 | */ | |
567 | ret = regulator_enable(par->regulator); | |
568 | if (ret) | |
569 | return ret; | |
570 | ||
571 | msleep(200); | |
572 | gpio_set_value(board->gpio_nrst, 1); | |
573 | gpio_set_value(board->gpio_nsleep, 1); | |
574 | msleep(200); | |
575 | } else { | |
576 | regulator_disable(par->regulator); | |
577 | gpio_set_value(board->gpio_nrst, 0); | |
578 | gpio_set_value(board->gpio_nsleep, 0); | |
579 | } | |
580 | ||
581 | return 0; | |
582 | } | |
583 | ||
584 | /* | |
585 | * Recovery - powercycle the controller | |
586 | */ | |
587 | ||
588 | static void auok190x_recover(struct auok190xfb_par *par) | |
589 | { | |
590 | auok190x_power(par, 0); | |
591 | msleep(100); | |
592 | auok190x_power(par, 1); | |
593 | ||
594 | par->init(par); | |
595 | ||
596 | /* wait for init to complete */ | |
597 | par->board->wait_for_rdy(par); | |
598 | } | |
599 | ||
600 | /* | |
601 | * Power-management | |
602 | */ | |
603 | ||
604 | #ifdef CONFIG_PM | |
605 | static int auok190x_runtime_suspend(struct device *dev) | |
606 | { | |
607 | struct platform_device *pdev = to_platform_device(dev); | |
608 | struct fb_info *info = platform_get_drvdata(pdev); | |
609 | struct auok190xfb_par *par = info->par; | |
610 | struct auok190x_board *board = par->board; | |
611 | u16 standby_param; | |
612 | ||
613 | /* take and keep the lock until we are resumed, as the controller | |
614 | * will never reach the non-busy state when in standby mode | |
615 | */ | |
616 | mutex_lock(&(par->io_lock)); | |
617 | ||
618 | if (par->standby) { | |
619 | dev_warn(dev, "already in standby, runtime-pm pairing mismatch\n"); | |
620 | mutex_unlock(&(par->io_lock)); | |
621 | return 0; | |
622 | } | |
623 | ||
624 | /* according to runtime_pm.txt runtime_suspend only means, that the | |
625 | * device will not process data and will not communicate with the CPU | |
626 | * As we hold the lock, this stays true even without standby | |
627 | */ | |
628 | if (board->quirks & AUOK190X_QUIRK_STANDBYBROKEN) { | |
629 | dev_dbg(dev, "runtime suspend without standby\n"); | |
630 | goto finish; | |
631 | } else if (board->quirks & AUOK190X_QUIRK_STANDBYPARAM) { | |
632 | /* for some TCON versions STANDBY expects a parameter (0) but | |
633 | * it seems the real tcon version has to be determined yet. | |
634 | */ | |
635 | dev_dbg(dev, "runtime suspend with additional empty param\n"); | |
636 | standby_param = 0; | |
637 | auok190x_send_cmdargs(par, AUOK190X_CMD_STANDBY, 1, | |
638 | &standby_param); | |
639 | } else { | |
640 | dev_dbg(dev, "runtime suspend without param\n"); | |
641 | auok190x_send_command(par, AUOK190X_CMD_STANDBY); | |
642 | } | |
643 | ||
644 | msleep(64); | |
645 | ||
646 | finish: | |
647 | par->standby = 1; | |
648 | ||
649 | return 0; | |
650 | } | |
651 | ||
652 | static int auok190x_runtime_resume(struct device *dev) | |
653 | { | |
654 | struct platform_device *pdev = to_platform_device(dev); | |
655 | struct fb_info *info = platform_get_drvdata(pdev); | |
656 | struct auok190xfb_par *par = info->par; | |
657 | struct auok190x_board *board = par->board; | |
658 | ||
659 | if (!par->standby) { | |
660 | dev_warn(dev, "not in standby, runtime-pm pairing mismatch\n"); | |
661 | return 0; | |
662 | } | |
663 | ||
664 | if (board->quirks & AUOK190X_QUIRK_STANDBYBROKEN) { | |
665 | dev_dbg(dev, "runtime resume without standby\n"); | |
666 | } else { | |
667 | /* when in standby, controller is always busy | |
668 | * and only accepts the wakeup command | |
669 | */ | |
670 | dev_dbg(dev, "runtime resume from standby\n"); | |
671 | auok190x_send_command_nowait(par, AUOK190X_CMD_WAKEUP); | |
672 | ||
673 | msleep(160); | |
674 | ||
675 | /* wait for the controller to be ready and release the lock */ | |
676 | board->wait_for_rdy(par); | |
677 | } | |
678 | ||
679 | par->standby = 0; | |
680 | ||
681 | mutex_unlock(&(par->io_lock)); | |
682 | ||
683 | return 0; | |
684 | } | |
685 | ||
686 | static int auok190x_suspend(struct device *dev) | |
687 | { | |
688 | struct platform_device *pdev = to_platform_device(dev); | |
689 | struct fb_info *info = platform_get_drvdata(pdev); | |
690 | struct auok190xfb_par *par = info->par; | |
691 | struct auok190x_board *board = par->board; | |
692 | int ret; | |
693 | ||
694 | dev_dbg(dev, "suspend\n"); | |
695 | if (board->quirks & AUOK190X_QUIRK_STANDBYBROKEN) { | |
696 | /* suspend via powering off the ic */ | |
697 | dev_dbg(dev, "suspend with broken standby\n"); | |
698 | ||
699 | auok190x_power(par, 0); | |
700 | } else { | |
701 | dev_dbg(dev, "suspend using sleep\n"); | |
702 | ||
703 | /* the sleep state can only be entered from the standby state. | |
704 | * pm_runtime_get_noresume gets called before the suspend call. | |
705 | * So the devices usage count is >0 but it is not necessarily | |
706 | * active. | |
707 | */ | |
708 | if (!pm_runtime_status_suspended(dev)) { | |
709 | ret = auok190x_runtime_suspend(dev); | |
710 | if (ret < 0) { | |
711 | dev_err(dev, "auok190x_runtime_suspend failed with %d\n", | |
712 | ret); | |
713 | return ret; | |
714 | } | |
715 | par->manual_standby = 1; | |
716 | } | |
717 | ||
718 | gpio_direction_output(board->gpio_nsleep, 0); | |
719 | } | |
720 | ||
721 | msleep(100); | |
722 | ||
723 | return 0; | |
724 | } | |
725 | ||
726 | static int auok190x_resume(struct device *dev) | |
727 | { | |
728 | struct platform_device *pdev = to_platform_device(dev); | |
729 | struct fb_info *info = platform_get_drvdata(pdev); | |
730 | struct auok190xfb_par *par = info->par; | |
731 | struct auok190x_board *board = par->board; | |
732 | ||
733 | dev_dbg(dev, "resume\n"); | |
734 | if (board->quirks & AUOK190X_QUIRK_STANDBYBROKEN) { | |
735 | dev_dbg(dev, "resume with broken standby\n"); | |
736 | ||
737 | auok190x_power(par, 1); | |
738 | ||
739 | par->init(par); | |
740 | } else { | |
741 | dev_dbg(dev, "resume from sleep\n"); | |
742 | ||
743 | /* device should be in runtime suspend when we were suspended | |
744 | * and pm_runtime_put_sync gets called after this function. | |
745 | * So there is no need to touch the standby mode here at all. | |
746 | */ | |
747 | gpio_direction_output(board->gpio_nsleep, 1); | |
748 | msleep(100); | |
749 | ||
750 | /* an additional init call seems to be necessary after sleep */ | |
751 | auok190x_runtime_resume(dev); | |
752 | par->init(par); | |
753 | ||
754 | /* if we were runtime-suspended before, suspend again*/ | |
755 | if (!par->manual_standby) | |
756 | auok190x_runtime_suspend(dev); | |
757 | else | |
758 | par->manual_standby = 0; | |
759 | } | |
760 | ||
761 | return 0; | |
762 | } | |
763 | #endif | |
764 | ||
765 | const struct dev_pm_ops auok190x_pm = { | |
766 | SET_RUNTIME_PM_OPS(auok190x_runtime_suspend, auok190x_runtime_resume, | |
767 | NULL) | |
768 | SET_SYSTEM_SLEEP_PM_OPS(auok190x_suspend, auok190x_resume) | |
769 | }; | |
770 | EXPORT_SYMBOL_GPL(auok190x_pm); | |
771 | ||
772 | /* | |
773 | * Common probe and remove code | |
774 | */ | |
775 | ||
48c68c4f GKH |
776 | int auok190x_common_probe(struct platform_device *pdev, |
777 | struct auok190x_init_data *init) | |
2c8304d3 HS |
778 | { |
779 | struct auok190x_board *board = init->board; | |
780 | struct auok190xfb_par *par; | |
781 | struct fb_info *info; | |
782 | struct panel_info *panel; | |
783 | int videomemorysize, ret; | |
784 | unsigned char *videomemory; | |
785 | ||
786 | /* check board contents */ | |
787 | if (!board->init || !board->cleanup || !board->wait_for_rdy | |
788 | || !board->set_ctl || !board->set_hdb || !board->get_hdb | |
789 | || !board->setup_irq) | |
790 | return -EINVAL; | |
791 | ||
792 | info = framebuffer_alloc(sizeof(struct auok190xfb_par), &pdev->dev); | |
793 | if (!info) | |
794 | return -ENOMEM; | |
795 | ||
796 | par = info->par; | |
797 | par->info = info; | |
798 | par->board = board; | |
799 | par->recover = auok190x_recover; | |
800 | par->update_partial = init->update_partial; | |
801 | par->update_all = init->update_all; | |
802 | par->need_refresh = init->need_refresh; | |
803 | par->init = init->init; | |
804 | ||
805 | /* init update modes */ | |
806 | par->update_cnt = 0; | |
807 | par->update_mode = -1; | |
808 | par->last_mode = -1; | |
809 | par->flash = 0; | |
810 | ||
811 | par->regulator = regulator_get(info->device, "vdd"); | |
812 | if (IS_ERR(par->regulator)) { | |
813 | ret = PTR_ERR(par->regulator); | |
814 | dev_err(info->device, "Failed to get regulator: %d\n", ret); | |
815 | goto err_reg; | |
816 | } | |
817 | ||
818 | ret = board->init(par); | |
819 | if (ret) { | |
820 | dev_err(info->device, "board init failed, %d\n", ret); | |
821 | goto err_board; | |
822 | } | |
823 | ||
824 | ret = gpio_request(board->gpio_nsleep, "AUOK190x sleep"); | |
825 | if (ret) { | |
826 | dev_err(info->device, "could not request sleep gpio, %d\n", | |
827 | ret); | |
828 | goto err_gpio1; | |
829 | } | |
830 | ||
831 | ret = gpio_direction_output(board->gpio_nsleep, 0); | |
832 | if (ret) { | |
833 | dev_err(info->device, "could not set sleep gpio, %d\n", ret); | |
834 | goto err_gpio2; | |
835 | } | |
836 | ||
837 | ret = gpio_request(board->gpio_nrst, "AUOK190x reset"); | |
838 | if (ret) { | |
839 | dev_err(info->device, "could not request reset gpio, %d\n", | |
840 | ret); | |
841 | goto err_gpio2; | |
842 | } | |
843 | ||
844 | ret = gpio_direction_output(board->gpio_nrst, 0); | |
845 | if (ret) { | |
846 | dev_err(info->device, "could not set reset gpio, %d\n", ret); | |
847 | goto err_gpio3; | |
848 | } | |
849 | ||
850 | ret = auok190x_power(par, 1); | |
851 | if (ret) { | |
852 | dev_err(info->device, "could not power on the device, %d\n", | |
853 | ret); | |
854 | goto err_gpio3; | |
855 | } | |
856 | ||
857 | mutex_init(&par->io_lock); | |
858 | ||
859 | init_waitqueue_head(&par->waitq); | |
860 | ||
861 | ret = par->board->setup_irq(par->info); | |
862 | if (ret) { | |
863 | dev_err(info->device, "could not setup ready-irq, %d\n", ret); | |
864 | goto err_irq; | |
865 | } | |
866 | ||
867 | /* wait for init to complete */ | |
868 | par->board->wait_for_rdy(par); | |
869 | ||
870 | /* | |
871 | * From here on the controller can talk to us | |
872 | */ | |
873 | ||
874 | /* initialise fix, var, resolution and rotation */ | |
875 | ||
876 | strlcpy(info->fix.id, init->id, 16); | |
877 | info->fix.type = FB_TYPE_PACKED_PIXELS; | |
878 | info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR; | |
879 | info->fix.xpanstep = 0; | |
880 | info->fix.ypanstep = 0; | |
881 | info->fix.ywrapstep = 0; | |
882 | info->fix.accel = FB_ACCEL_NONE; | |
883 | ||
884 | info->var.bits_per_pixel = 8; | |
885 | info->var.grayscale = 1; | |
886 | info->var.red.length = 8; | |
887 | info->var.green.length = 8; | |
888 | info->var.blue.length = 8; | |
889 | ||
890 | panel = &panel_table[board->resolution]; | |
891 | ||
892 | /* if 90 degree rotation, switch width and height */ | |
893 | if (board->rotation & 1) { | |
894 | info->var.xres = panel->h; | |
895 | info->var.yres = panel->w; | |
896 | info->var.xres_virtual = panel->h; | |
897 | info->var.yres_virtual = panel->w; | |
898 | info->fix.line_length = panel->h; | |
899 | } else { | |
900 | info->var.xres = panel->w; | |
901 | info->var.yres = panel->h; | |
902 | info->var.xres_virtual = panel->w; | |
903 | info->var.yres_virtual = panel->h; | |
904 | info->fix.line_length = panel->w; | |
905 | } | |
906 | ||
907 | par->resolution = board->resolution; | |
908 | par->rotation = board->rotation; | |
909 | ||
910 | /* videomemory handling */ | |
911 | ||
912 | videomemorysize = roundup((panel->w * panel->h), PAGE_SIZE); | |
913 | videomemory = vmalloc(videomemorysize); | |
914 | if (!videomemory) { | |
915 | ret = -ENOMEM; | |
916 | goto err_irq; | |
917 | } | |
918 | ||
919 | memset(videomemory, 0, videomemorysize); | |
920 | info->screen_base = (char *)videomemory; | |
921 | info->fix.smem_len = videomemorysize; | |
922 | ||
923 | info->flags = FBINFO_FLAG_DEFAULT | FBINFO_VIRTFB; | |
924 | info->fbops = &auok190xfb_ops; | |
925 | ||
926 | /* deferred io init */ | |
927 | ||
928 | info->fbdefio = devm_kzalloc(info->device, | |
929 | sizeof(struct fb_deferred_io), | |
930 | GFP_KERNEL); | |
931 | if (!info->fbdefio) { | |
932 | dev_err(info->device, "Failed to allocate memory\n"); | |
933 | ret = -ENOMEM; | |
934 | goto err_defio; | |
935 | } | |
936 | ||
937 | dev_dbg(info->device, "targetting %d frames per second\n", board->fps); | |
938 | info->fbdefio->delay = HZ / board->fps; | |
939 | info->fbdefio->first_io = auok190xfb_dpy_first_io, | |
940 | info->fbdefio->deferred_io = auok190xfb_dpy_deferred_io, | |
941 | fb_deferred_io_init(info); | |
942 | ||
943 | /* color map */ | |
944 | ||
945 | ret = fb_alloc_cmap(&info->cmap, 256, 0); | |
946 | if (ret < 0) { | |
947 | dev_err(info->device, "Failed to allocate colormap\n"); | |
948 | goto err_cmap; | |
949 | } | |
950 | ||
951 | /* controller init */ | |
952 | ||
953 | par->consecutive_threshold = 100; | |
954 | par->init(par); | |
955 | auok190x_identify(par); | |
956 | ||
957 | platform_set_drvdata(pdev, info); | |
958 | ||
959 | ret = register_framebuffer(info); | |
960 | if (ret < 0) | |
961 | goto err_regfb; | |
962 | ||
963 | ret = sysfs_create_group(&info->device->kobj, &auok190x_attr_group); | |
964 | if (ret) | |
965 | goto err_sysfs; | |
966 | ||
967 | dev_info(info->device, "fb%d: %dx%d using %dK of video memory\n", | |
968 | info->node, info->var.xres, info->var.yres, | |
969 | videomemorysize >> 10); | |
970 | ||
971 | /* increase autosuspend_delay when we use alternative methods | |
972 | * for runtime_pm | |
973 | */ | |
974 | par->autosuspend_delay = (board->quirks & AUOK190X_QUIRK_STANDBYBROKEN) | |
975 | ? 1000 : 200; | |
976 | ||
977 | pm_runtime_set_active(info->device); | |
978 | pm_runtime_enable(info->device); | |
979 | pm_runtime_set_autosuspend_delay(info->device, par->autosuspend_delay); | |
980 | pm_runtime_use_autosuspend(info->device); | |
981 | ||
982 | return 0; | |
983 | ||
984 | err_sysfs: | |
985 | unregister_framebuffer(info); | |
986 | err_regfb: | |
987 | fb_dealloc_cmap(&info->cmap); | |
988 | err_cmap: | |
989 | fb_deferred_io_cleanup(info); | |
2c8304d3 HS |
990 | err_defio: |
991 | vfree((void *)info->screen_base); | |
992 | err_irq: | |
993 | auok190x_power(par, 0); | |
994 | err_gpio3: | |
995 | gpio_free(board->gpio_nrst); | |
996 | err_gpio2: | |
997 | gpio_free(board->gpio_nsleep); | |
998 | err_gpio1: | |
999 | board->cleanup(par); | |
1000 | err_board: | |
1001 | regulator_put(par->regulator); | |
1002 | err_reg: | |
1003 | framebuffer_release(info); | |
1004 | ||
1005 | return ret; | |
1006 | } | |
1007 | EXPORT_SYMBOL_GPL(auok190x_common_probe); | |
1008 | ||
48c68c4f | 1009 | int auok190x_common_remove(struct platform_device *pdev) |
2c8304d3 HS |
1010 | { |
1011 | struct fb_info *info = platform_get_drvdata(pdev); | |
1012 | struct auok190xfb_par *par = info->par; | |
1013 | struct auok190x_board *board = par->board; | |
1014 | ||
1015 | pm_runtime_disable(info->device); | |
1016 | ||
1017 | sysfs_remove_group(&info->device->kobj, &auok190x_attr_group); | |
1018 | ||
1019 | unregister_framebuffer(info); | |
1020 | ||
1021 | fb_dealloc_cmap(&info->cmap); | |
1022 | ||
1023 | fb_deferred_io_cleanup(info); | |
2c8304d3 HS |
1024 | |
1025 | vfree((void *)info->screen_base); | |
1026 | ||
1027 | auok190x_power(par, 0); | |
1028 | ||
1029 | gpio_free(board->gpio_nrst); | |
1030 | gpio_free(board->gpio_nsleep); | |
1031 | ||
1032 | board->cleanup(par); | |
1033 | ||
1034 | regulator_put(par->regulator); | |
1035 | ||
1036 | framebuffer_release(info); | |
1037 | ||
1038 | return 0; | |
1039 | } | |
1040 | EXPORT_SYMBOL_GPL(auok190x_common_remove); | |
1041 | ||
1042 | MODULE_DESCRIPTION("Common code for AUO-K190X controllers"); | |
1043 | MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>"); | |
1044 | MODULE_LICENSE("GPL"); |