ssd1307fb.c 17.4 KB
Newer Older
1
/*
M
Masanari Iida 已提交
2
 * Driver for the Solomon SSD1307 OLED controller
3 4 5 6 7 8 9
 *
 * Copyright 2012 Free Electrons
 *
 * Licensed under the GPLv2 or later.
 */

#include <linux/module.h>
10
#include <linux/backlight.h>
11 12 13 14 15 16 17 18 19 20 21 22
#include <linux/kernel.h>
#include <linux/i2c.h>
#include <linux/fb.h>
#include <linux/uaccess.h>
#include <linux/of_device.h>
#include <linux/of_gpio.h>
#include <linux/pwm.h>
#include <linux/delay.h>

#define SSD1307FB_DATA			0x40
#define SSD1307FB_COMMAND		0x80

23 24 25 26 27 28
#define SSD1307FB_SET_ADDRESS_MODE	0x20
#define SSD1307FB_SET_ADDRESS_MODE_HORIZONTAL	(0x00)
#define SSD1307FB_SET_ADDRESS_MODE_VERTICAL	(0x01)
#define SSD1307FB_SET_ADDRESS_MODE_PAGE		(0x02)
#define SSD1307FB_SET_COL_RANGE		0x21
#define SSD1307FB_SET_PAGE_RANGE	0x22
29
#define SSD1307FB_CONTRAST		0x81
30
#define	SSD1307FB_CHARGE_PUMP		0x8d
31 32
#define SSD1307FB_SEG_REMAP_ON		0xa1
#define SSD1307FB_DISPLAY_OFF		0xae
33
#define SSD1307FB_SET_MULTIPLEX_RATIO	0xa8
34 35
#define SSD1307FB_DISPLAY_ON		0xaf
#define SSD1307FB_START_PAGE_ADDRESS	0xb0
36 37 38 39 40 41
#define SSD1307FB_SET_DISPLAY_OFFSET	0xd3
#define	SSD1307FB_SET_CLOCK_FREQ	0xd5
#define	SSD1307FB_SET_PRECHARGE_PERIOD	0xd9
#define	SSD1307FB_SET_COM_PINS_CONFIG	0xda
#define	SSD1307FB_SET_VCOMH		0xdb

42 43
#define MAX_CONTRAST 255

44 45 46 47 48
#define REFRESHRATE 1

static u_int refreshrate = REFRESHRATE;
module_param(refreshrate, uint, 0);

49 50
struct ssd1307fb_par;

51 52 53 54 55 56
struct ssd1307fb_deviceinfo {
	u32 default_vcomh;
	u32 default_dclk_div;
	u32 default_dclk_frq;
	int need_pwm;
	int need_chargepump;
57
};
58 59

struct ssd1307fb_par {
60 61 62 63 64 65 66 67
	u32 com_invdir;
	u32 com_lrremap;
	u32 com_offset;
	u32 com_seq;
	u32 contrast;
	u32 dclk_div;
	u32 dclk_frq;
	struct ssd1307fb_deviceinfo *device_info;
68
	struct i2c_client *client;
69
	u32 height;
70
	struct fb_info *info;
71
	u32 page_offset;
72 73
	u32 prechargep1;
	u32 prechargep2;
74 75 76
	struct pwm_device *pwm;
	u32 pwm_period;
	int reset;
77 78
	u32 seg_remap;
	u32 vcomh;
79
	u32 width;
80 81
};

82 83 84 85 86
struct ssd1307fb_array {
	u8	type;
	u8	data[0];
};

87
static struct fb_fix_screeninfo ssd1307fb_fix = {
88 89 90 91 92 93 94 95 96
	.id		= "Solomon SSD1307",
	.type		= FB_TYPE_PACKED_PIXELS,
	.visual		= FB_VISUAL_MONO10,
	.xpanstep	= 0,
	.ypanstep	= 0,
	.ywrapstep	= 0,
	.accel		= FB_ACCEL_NONE,
};

97
static struct fb_var_screeninfo ssd1307fb_var = {
98 99 100
	.bits_per_pixel	= 1,
};

101
static struct ssd1307fb_array *ssd1307fb_alloc_array(u32 len, u8 type)
102
{
103
	struct ssd1307fb_array *array;
104

105 106 107
	array = kzalloc(sizeof(struct ssd1307fb_array) + len, GFP_KERNEL);
	if (!array)
		return NULL;
108

109
	array->type = type;
110

111
	return array;
112 113
}

114 115
static int ssd1307fb_write_array(struct i2c_client *client,
				 struct ssd1307fb_array *array, u32 len)
116
{
117 118 119 120 121 122 123 124 125 126 127
	int ret;

	len += sizeof(struct ssd1307fb_array);

	ret = i2c_master_send(client, (u8 *)array, len);
	if (ret != len) {
		dev_err(&client->dev, "Couldn't send I2C command.\n");
		return ret;
	}

	return 0;
128 129 130 131
}

static inline int ssd1307fb_write_cmd(struct i2c_client *client, u8 cmd)
{
132 133
	struct ssd1307fb_array *array;
	int ret;
134

135 136 137 138 139 140 141 142 143 144
	array = ssd1307fb_alloc_array(1, SSD1307FB_COMMAND);
	if (!array)
		return -ENOMEM;

	array->data[0] = cmd;

	ret = ssd1307fb_write_array(client, array, 1);
	kfree(array);

	return ret;
145 146 147 148
}

static void ssd1307fb_update_display(struct ssd1307fb_par *par)
{
149
	struct ssd1307fb_array *array;
150 151 152
	u8 *vmem = par->info->screen_base;
	int i, j, k;

153 154 155 156 157
	array = ssd1307fb_alloc_array(par->width * par->height / 8,
				      SSD1307FB_DATA);
	if (!array)
		return;

158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186
	/*
	 * The screen is divided in pages, each having a height of 8
	 * pixels, and the width of the screen. When sending a byte of
	 * data to the controller, it gives the 8 bits for the current
	 * column. I.e, the first byte are the 8 bits of the first
	 * column, then the 8 bits for the second column, etc.
	 *
	 *
	 * Representation of the screen, assuming it is 5 bits
	 * wide. Each letter-number combination is a bit that controls
	 * one pixel.
	 *
	 * A0 A1 A2 A3 A4
	 * B0 B1 B2 B3 B4
	 * C0 C1 C2 C3 C4
	 * D0 D1 D2 D3 D4
	 * E0 E1 E2 E3 E4
	 * F0 F1 F2 F3 F4
	 * G0 G1 G2 G3 G4
	 * H0 H1 H2 H3 H4
	 *
	 * If you want to update this screen, you need to send 5 bytes:
	 *  (1) A0 B0 C0 D0 E0 F0 G0 H0
	 *  (2) A1 B1 C1 D1 E1 F1 G1 H1
	 *  (3) A2 B2 C2 D2 E2 F2 G2 H2
	 *  (4) A3 B3 C3 D3 E3 F3 G3 H3
	 *  (5) A4 B4 C4 D4 E4 F4 G4 H4
	 */

187 188
	for (i = 0; i < (par->height / 8); i++) {
		for (j = 0; j < par->width; j++) {
189 190
			u32 array_idx = i * par->width + j;
			array->data[array_idx] = 0;
191
			for (k = 0; k < 8; k++) {
192 193
				u32 page_length = par->width * i;
				u32 index = page_length + (par->width * k + j) / 8;
194
				u8 byte = *(vmem + index);
195 196
				u8 bit = byte & (1 << (j % 8));
				bit = bit >> (j % 8);
197
				array->data[array_idx] |= bit << k;
198 199 200
			}
		}
	}
201 202 203

	ssd1307fb_write_array(par->client, array, par->width * par->height / 8);
	kfree(array);
204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237
}


static ssize_t ssd1307fb_write(struct fb_info *info, const char __user *buf,
		size_t count, loff_t *ppos)
{
	struct ssd1307fb_par *par = info->par;
	unsigned long total_size;
	unsigned long p = *ppos;
	u8 __iomem *dst;

	total_size = info->fix.smem_len;

	if (p > total_size)
		return -EINVAL;

	if (count + p > total_size)
		count = total_size - p;

	if (!count)
		return -EINVAL;

	dst = (void __force *) (info->screen_base + p);

	if (copy_from_user(dst, buf, count))
		return -EFAULT;

	ssd1307fb_update_display(par);

	*ppos += count;

	return count;
}

238 239 240 241 242 243 244 245 246 247
static int ssd1307fb_blank(int blank_mode, struct fb_info *info)
{
	struct ssd1307fb_par *par = info->par;

	if (blank_mode != FB_BLANK_UNBLANK)
		return ssd1307fb_write_cmd(par->client, SSD1307FB_DISPLAY_OFF);
	else
		return ssd1307fb_write_cmd(par->client, SSD1307FB_DISPLAY_ON);
}

248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
static void ssd1307fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
{
	struct ssd1307fb_par *par = info->par;
	sys_fillrect(info, rect);
	ssd1307fb_update_display(par);
}

static void ssd1307fb_copyarea(struct fb_info *info, const struct fb_copyarea *area)
{
	struct ssd1307fb_par *par = info->par;
	sys_copyarea(info, area);
	ssd1307fb_update_display(par);
}

static void ssd1307fb_imageblit(struct fb_info *info, const struct fb_image *image)
{
	struct ssd1307fb_par *par = info->par;
	sys_imageblit(info, image);
	ssd1307fb_update_display(par);
}

static struct fb_ops ssd1307fb_ops = {
	.owner		= THIS_MODULE,
	.fb_read	= fb_sys_read,
	.fb_write	= ssd1307fb_write,
273
	.fb_blank	= ssd1307fb_blank,
274 275 276 277 278 279 280 281 282 283 284
	.fb_fillrect	= ssd1307fb_fillrect,
	.fb_copyarea	= ssd1307fb_copyarea,
	.fb_imageblit	= ssd1307fb_imageblit,
};

static void ssd1307fb_deferred_io(struct fb_info *info,
				struct list_head *pagelist)
{
	ssd1307fb_update_display(info->par);
}

285
static int ssd1307fb_init(struct ssd1307fb_par *par)
286 287
{
	int ret;
288
	u32 precharge, dclk, com_invdir, compins;
289

290 291 292 293 294 295
	if (par->device_info->need_pwm) {
		par->pwm = pwm_get(&par->client->dev, NULL);
		if (IS_ERR(par->pwm)) {
			dev_err(&par->client->dev, "Could not get PWM from device tree!\n");
			return PTR_ERR(par->pwm);
		}
296

297 298 299 300
		par->pwm_period = pwm_get_period(par->pwm);
		/* Enable the PWM */
		pwm_config(par->pwm, par->pwm_period / 2, par->pwm_period);
		pwm_enable(par->pwm);
301

302 303 304
		dev_dbg(&par->client->dev, "Using PWM%d with a %dns period.\n",
			par->pwm->pwm, par->pwm_period);
	};
305 306 307

	/* Set initial contrast */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_CONTRAST);
308 309 310
	if (ret < 0)
		return ret;

311
	ret = ssd1307fb_write_cmd(par->client, par->contrast);
312 313 314 315
	if (ret < 0)
		return ret;

	/* Set segment re-map */
316 317 318 319 320 321 322 323 324
	if (par->seg_remap) {
		ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SEG_REMAP_ON);
		if (ret < 0)
			return ret;
	};

	/* Set COM direction */
	com_invdir = 0xc0 | (par->com_invdir & 0x1) << 3;
	ret = ssd1307fb_write_cmd(par->client,  com_invdir);
325 326 327 328 329
	if (ret < 0)
		return ret;

	/* Set multiplex ratio value */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_MULTIPLEX_RATIO);
330 331 332 333
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client, par->height - 1);
334 335 336 337 338
	if (ret < 0)
		return ret;

	/* set display offset value */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_DISPLAY_OFFSET);
339 340 341
	if (ret < 0)
		return ret;

342
	ret = ssd1307fb_write_cmd(par->client, par->com_offset);
343 344 345 346 347
	if (ret < 0)
		return ret;

	/* Set clock frequency */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_CLOCK_FREQ);
348 349 350
	if (ret < 0)
		return ret;

351 352
	dclk = ((par->dclk_div - 1) & 0xf) | (par->dclk_frq & 0xf) << 4;
	ret = ssd1307fb_write_cmd(par->client, dclk);
353 354 355 356 357
	if (ret < 0)
		return ret;

	/* Set precharge period in number of ticks from the internal clock */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_PRECHARGE_PERIOD);
358 359 360
	if (ret < 0)
		return ret;

361 362
	precharge = (par->prechargep1 & 0xf) | (par->prechargep2 & 0xf) << 4;
	ret = ssd1307fb_write_cmd(par->client, precharge);
363 364 365 366 367
	if (ret < 0)
		return ret;

	/* Set COM pins configuration */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_COM_PINS_CONFIG);
368 369 370
	if (ret < 0)
		return ret;

371 372 373
	compins = 0x02 | (!par->com_seq & 0x1) << 4
				   | (par->com_lrremap & 0x1) << 5;
	ret = ssd1307fb_write_cmd(par->client, compins);
374 375 376 377 378
	if (ret < 0)
		return ret;

	/* Set VCOMH */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_VCOMH);
379 380 381
	if (ret < 0)
		return ret;

382
	ret = ssd1307fb_write_cmd(par->client, par->vcomh);
383 384 385 386 387
	if (ret < 0)
		return ret;

	/* Turn on the DC-DC Charge Pump */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_CHARGE_PUMP);
388 389 390
	if (ret < 0)
		return ret;

391 392
	ret = ssd1307fb_write_cmd(par->client,
		(par->device_info->need_chargepump & 0x1 << 2) & 0x14);
393 394 395
	if (ret < 0)
		return ret;

396 397
	/* Switch to horizontal addressing mode */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_ADDRESS_MODE);
398 399 400 401 402
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client,
				  SSD1307FB_SET_ADDRESS_MODE_HORIZONTAL);
403 404 405
	if (ret < 0)
		return ret;

406
	/* Set column range */
407
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_COL_RANGE);
408 409 410 411 412 413 414 415
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client, 0x0);
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client, par->width - 1);
416 417 418
	if (ret < 0)
		return ret;

419
	/* Set page range */
420
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_PAGE_RANGE);
421 422 423 424 425 426 427 428 429
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client, 0x0);
	if (ret < 0)
		return ret;

	ret = ssd1307fb_write_cmd(par->client,
				  par->page_offset + (par->height / 8) - 1);
430 431 432
	if (ret < 0)
		return ret;

433 434 435 436 437 438 439 440
	/* Turn on the display */
	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_DISPLAY_ON);
	if (ret < 0)
		return ret;

	return 0;
}

441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477
static int ssd1307fb_update_bl(struct backlight_device *bdev)
{
	struct ssd1307fb_par *par = bl_get_data(bdev);
	int ret;
	int brightness = bdev->props.brightness;

	par->contrast = brightness;

	ret = ssd1307fb_write_cmd(par->client, SSD1307FB_CONTRAST);
	if (ret < 0)
		return ret;
	ret = ssd1307fb_write_cmd(par->client, par->contrast);
	if (ret < 0)
		return ret;
	return 0;
}

static int ssd1307fb_get_brightness(struct backlight_device *bdev)
{
	struct ssd1307fb_par *par = bl_get_data(bdev);

	return par->contrast;
}

static int ssd1307fb_check_fb(struct backlight_device *bdev,
				   struct fb_info *info)
{
	return (info->bl_dev == bdev);
}

static const struct backlight_ops ssd1307fb_bl_ops = {
	.options	= BL_CORE_SUSPENDRESUME,
	.update_status	= ssd1307fb_update_bl,
	.get_brightness	= ssd1307fb_get_brightness,
	.check_fb	= ssd1307fb_check_fb,
};

478 479 480 481 482 483
static struct ssd1307fb_deviceinfo ssd1307fb_ssd1305_deviceinfo = {
	.default_vcomh = 0x34,
	.default_dclk_div = 1,
	.default_dclk_frq = 7,
};

484 485 486 487 488 489 490 491 492 493 494 495
static struct ssd1307fb_deviceinfo ssd1307fb_ssd1306_deviceinfo = {
	.default_vcomh = 0x20,
	.default_dclk_div = 1,
	.default_dclk_frq = 8,
	.need_chargepump = 1,
};

static struct ssd1307fb_deviceinfo ssd1307fb_ssd1307_deviceinfo = {
	.default_vcomh = 0x20,
	.default_dclk_div = 2,
	.default_dclk_frq = 12,
	.need_pwm = 1,
496 497 498
};

static const struct of_device_id ssd1307fb_of_match[] = {
499 500 501 502
	{
		.compatible = "solomon,ssd1305fb-i2c",
		.data = (void *)&ssd1307fb_ssd1305_deviceinfo,
	},
503 504
	{
		.compatible = "solomon,ssd1306fb-i2c",
505
		.data = (void *)&ssd1307fb_ssd1306_deviceinfo,
506 507 508
	},
	{
		.compatible = "solomon,ssd1307fb-i2c",
509
		.data = (void *)&ssd1307fb_ssd1307_deviceinfo,
510 511 512 513 514
	},
	{},
};
MODULE_DEVICE_TABLE(of, ssd1307fb_of_match);

515 516
static int ssd1307fb_probe(struct i2c_client *client,
			   const struct i2c_device_id *id)
517
{
518 519
	struct backlight_device *bl;
	char bl_name[12];
520
	struct fb_info *info;
521
	struct device_node *node = client->dev.of_node;
522
	struct fb_deferred_io *ssd1307fb_defio;
523
	u32 vmem_size;
524 525 526 527
	struct ssd1307fb_par *par;
	u8 *vmem;
	int ret;

528
	if (!node) {
529 530 531 532 533 534 535 536 537 538
		dev_err(&client->dev, "No device tree data found!\n");
		return -EINVAL;
	}

	info = framebuffer_alloc(sizeof(struct ssd1307fb_par), &client->dev);
	if (!info) {
		dev_err(&client->dev, "Couldn't allocate framebuffer.\n");
		return -ENOMEM;
	}

539 540 541 542
	par = info->par;
	par->info = info;
	par->client = client;

543 544
	par->device_info = (struct ssd1307fb_deviceinfo *)of_match_device(
			ssd1307fb_of_match, &client->dev)->data;
545 546 547 548 549 550 551 552 553 554 555 556

	par->reset = of_get_named_gpio(client->dev.of_node,
					 "reset-gpios", 0);
	if (!gpio_is_valid(par->reset)) {
		ret = -EINVAL;
		goto fb_alloc_error;
	}

	if (of_property_read_u32(node, "solomon,width", &par->width))
		par->width = 96;

	if (of_property_read_u32(node, "solomon,height", &par->height))
557
		par->height = 16;
558 559 560 561

	if (of_property_read_u32(node, "solomon,page-offset", &par->page_offset))
		par->page_offset = 1;

562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582
	if (of_property_read_u32(node, "solomon,com-offset", &par->com_offset))
		par->com_offset = 0;

	if (of_property_read_u32(node, "solomon,prechargep1", &par->prechargep1))
		par->prechargep1 = 2;

	if (of_property_read_u32(node, "solomon,prechargep2", &par->prechargep2))
		par->prechargep2 = 2;

	par->seg_remap = !of_property_read_bool(node, "solomon,segment-no-remap");
	par->com_seq = of_property_read_bool(node, "solomon,com-seq");
	par->com_lrremap = of_property_read_bool(node, "solomon,com-lrremap");
	par->com_invdir = of_property_read_bool(node, "solomon,com-invdir");

	par->contrast = 127;
	par->vcomh = par->device_info->default_vcomh;

	/* Setup display timing */
	par->dclk_div = par->device_info->default_dclk_div;
	par->dclk_frq = par->device_info->default_dclk_frq;

583 584
	vmem_size = par->width * par->height / 8;

585 586
	vmem = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO,
					get_order(vmem_size));
587 588 589 590 591 592
	if (!vmem) {
		dev_err(&client->dev, "Couldn't allocate graphical memory.\n");
		ret = -ENOMEM;
		goto fb_alloc_error;
	}

593 594 595 596 597 598 599 600 601 602
	ssd1307fb_defio = devm_kzalloc(&client->dev, sizeof(struct fb_deferred_io), GFP_KERNEL);
	if (!ssd1307fb_defio) {
		dev_err(&client->dev, "Couldn't allocate deferred io.\n");
		ret = -ENOMEM;
		goto fb_alloc_error;
	}

	ssd1307fb_defio->delay = HZ / refreshrate;
	ssd1307fb_defio->deferred_io = ssd1307fb_deferred_io;

603 604
	info->fbops = &ssd1307fb_ops;
	info->fix = ssd1307fb_fix;
605
	info->fix.line_length = par->width / 8;
606
	info->fbdefio = ssd1307fb_defio;
607 608

	info->var = ssd1307fb_var;
609 610 611 612 613
	info->var.xres = par->width;
	info->var.xres_virtual = par->width;
	info->var.yres = par->height;
	info->var.yres_virtual = par->height;

614 615 616 617 618 619 620 621
	info->var.red.length = 1;
	info->var.red.offset = 0;
	info->var.green.length = 1;
	info->var.green.offset = 0;
	info->var.blue.length = 1;
	info->var.blue.offset = 0;

	info->screen_base = (u8 __force __iomem *)vmem;
622
	info->fix.smem_start = __pa(vmem);
623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644
	info->fix.smem_len = vmem_size;

	fb_deferred_io_init(info);

	ret = devm_gpio_request_one(&client->dev, par->reset,
				    GPIOF_OUT_INIT_HIGH,
				    "oled-reset");
	if (ret) {
		dev_err(&client->dev,
			"failed to request gpio %d: %d\n",
			par->reset, ret);
		goto reset_oled_error;
	}

	i2c_set_clientdata(client, info);

	/* Reset the screen */
	gpio_set_value(par->reset, 0);
	udelay(4);
	gpio_set_value(par->reset, 1);
	udelay(4);

645 646 647
	ret = ssd1307fb_init(par);
	if (ret)
		goto reset_oled_error;
648

649 650 651 652
	ret = register_framebuffer(info);
	if (ret) {
		dev_err(&client->dev, "Couldn't register the framebuffer\n");
		goto panel_init_error;
653 654
	}

655 656 657 658 659 660 661 662 663 664 665 666
	snprintf(bl_name, sizeof(bl_name), "ssd1307fb%d", info->node);
	bl = backlight_device_register(bl_name, &client->dev, par,
				       &ssd1307fb_bl_ops, NULL);
	bl->props.brightness = par->contrast;
	bl->props.max_brightness = MAX_CONTRAST;
	info->bl_dev = bl;

	if (IS_ERR(bl)) {
		dev_err(&client->dev, "unable to register backlight device: %ld\n",
			PTR_ERR(bl));
		goto bl_init_error;
	}
667 668 669 670
	dev_info(&client->dev, "fb%d: %s framebuffer device registered, using %d bytes of video memory\n", info->node, info->fix.id, vmem_size);

	return 0;

671 672
bl_init_error:
	unregister_framebuffer(info);
673
panel_init_error:
674 675 676 677
	if (par->device_info->need_pwm) {
		pwm_disable(par->pwm);
		pwm_put(par->pwm);
	};
678 679 680 681 682 683 684
reset_oled_error:
	fb_deferred_io_cleanup(info);
fb_alloc_error:
	framebuffer_release(info);
	return ret;
}

685
static int ssd1307fb_remove(struct i2c_client *client)
686 687 688 689
{
	struct fb_info *info = i2c_get_clientdata(client);
	struct ssd1307fb_par *par = info->par;

690 691
	ssd1307fb_write_cmd(par->client, SSD1307FB_DISPLAY_OFF);

692 693
	backlight_device_unregister(info->bl_dev);

694
	unregister_framebuffer(info);
695 696 697 698
	if (par->device_info->need_pwm) {
		pwm_disable(par->pwm);
		pwm_put(par->pwm);
	};
699
	fb_deferred_io_cleanup(info);
700
	__free_pages(__va(info->fix.smem_start), get_order(info->fix.smem_len));
701 702 703 704 705 706
	framebuffer_release(info);

	return 0;
}

static const struct i2c_device_id ssd1307fb_i2c_id[] = {
707
	{ "ssd1305fb", 0 },
708
	{ "ssd1306fb", 0 },
709 710 711 712 713 714 715
	{ "ssd1307fb", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, ssd1307fb_i2c_id);

static struct i2c_driver ssd1307fb_driver = {
	.probe = ssd1307fb_probe,
716
	.remove = ssd1307fb_remove,
717 718 719
	.id_table = ssd1307fb_i2c_id,
	.driver = {
		.name = "ssd1307fb",
720
		.of_match_table = ssd1307fb_of_match,
721 722 723 724 725 726
		.owner = THIS_MODULE,
	},
};

module_i2c_driver(ssd1307fb_driver);

M
Masanari Iida 已提交
727
MODULE_DESCRIPTION("FB driver for the Solomon SSD1307 OLED controller");
728 729
MODULE_AUTHOR("Maxime Ripard <maxime.ripard@free-electrons.com>");
MODULE_LICENSE("GPL");