mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-12-25 15:06:47 +02:00
[s3c24xx] jbt6k74:
* Register a lcd device. * Add callbacks to allow the graphics chip to disable the pixel clock. * Delay blanking to avoid white flash. git-svn-id: svn://svn.openwrt.org/openwrt/trunk@16616 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
parent
20f89b92f3
commit
6e6898e461
@ -4,6 +4,7 @@
|
|||||||
* Author: Harald Welte <laforge@openmoko.org>,
|
* Author: Harald Welte <laforge@openmoko.org>,
|
||||||
* Stefan Schmidt <stefan@openmoko.org>
|
* Stefan Schmidt <stefan@openmoko.org>
|
||||||
* Copyright (C) 2008 by Harald Welte <laforge@openmoko.org>
|
* Copyright (C) 2008 by Harald Welte <laforge@openmoko.org>
|
||||||
|
* Copyright (C) 2009 by Lars-Peter Clausen <lars@metafoo.de>
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or
|
* This program is free software; you can redistribute it and/or
|
||||||
@ -29,8 +30,10 @@
|
|||||||
#include <linux/device.h>
|
#include <linux/device.h>
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
|
#include <linux/workqueue.h>
|
||||||
#include <linux/jbt6k74.h>
|
#include <linux/jbt6k74.h>
|
||||||
#include <linux/fb.h>
|
#include <linux/fb.h>
|
||||||
|
#include <linux/lcd.h>
|
||||||
#include <linux/time.h>
|
#include <linux/time.h>
|
||||||
|
|
||||||
enum jbt_register {
|
enum jbt_register {
|
||||||
@ -120,14 +123,18 @@ static const char *jbt_resolution_names[] = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
struct jbt_info {
|
struct jbt_info {
|
||||||
|
struct mutex lock; /* protects this structure */
|
||||||
enum jbt_resolution resolution;
|
enum jbt_resolution resolution;
|
||||||
enum jbt_power_mode power_mode;
|
enum jbt_power_mode power_mode;
|
||||||
|
enum jbt_power_mode suspend_mode;
|
||||||
|
int suspended;
|
||||||
struct spi_device *spi_dev;
|
struct spi_device *spi_dev;
|
||||||
struct mutex lock; /* protects tx_buf and reg_cache */
|
struct lcd_device *lcd_dev;
|
||||||
struct notifier_block fb_notif;
|
|
||||||
u16 tx_buf[8];
|
|
||||||
u16 reg_cache[0xEE];
|
|
||||||
unsigned long last_sleep;
|
unsigned long last_sleep;
|
||||||
|
struct delayed_work blank_work;
|
||||||
|
int blank_mode;
|
||||||
|
u16 tx_buf[4];
|
||||||
|
u16 reg_cache[0xEE];
|
||||||
};
|
};
|
||||||
|
|
||||||
#define JBT_COMMAND 0x000
|
#define JBT_COMMAND 0x000
|
||||||
@ -139,7 +146,7 @@ static int jbt_reg_write_nodata(struct jbt_info *jbt, u8 reg)
|
|||||||
|
|
||||||
jbt->tx_buf[0] = JBT_COMMAND | reg;
|
jbt->tx_buf[0] = JBT_COMMAND | reg;
|
||||||
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
||||||
1*sizeof(u16));
|
1*sizeof(u16));
|
||||||
if (rc == 0)
|
if (rc == 0)
|
||||||
jbt->reg_cache[reg] = 0;
|
jbt->reg_cache[reg] = 0;
|
||||||
else
|
else
|
||||||
@ -157,7 +164,7 @@ static int jbt_reg_write(struct jbt_info *jbt, u8 reg, u8 data)
|
|||||||
jbt->tx_buf[0] = JBT_COMMAND | reg;
|
jbt->tx_buf[0] = JBT_COMMAND | reg;
|
||||||
jbt->tx_buf[1] = JBT_DATA | data;
|
jbt->tx_buf[1] = JBT_DATA | data;
|
||||||
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
||||||
2*sizeof(u16));
|
2*sizeof(u16));
|
||||||
if (rc == 0)
|
if (rc == 0)
|
||||||
jbt->reg_cache[reg] = data;
|
jbt->reg_cache[reg] = data;
|
||||||
else
|
else
|
||||||
@ -175,7 +182,7 @@ static int jbt_reg_write16(struct jbt_info *jbt, u8 reg, u16 data)
|
|||||||
jbt->tx_buf[2] = JBT_DATA | (data & 0xff);
|
jbt->tx_buf[2] = JBT_DATA | (data & 0xff);
|
||||||
|
|
||||||
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
rc = spi_write(jbt->spi_dev, (u8 *)jbt->tx_buf,
|
||||||
3*sizeof(u16));
|
3*sizeof(u16));
|
||||||
if (rc == 0)
|
if (rc == 0)
|
||||||
jbt->reg_cache[reg] = data;
|
jbt->reg_cache[reg] = data;
|
||||||
else
|
else
|
||||||
@ -207,7 +214,7 @@ static int jbt_init_regs(struct jbt_info *jbt)
|
|||||||
* default of 0x02 in JBT_REG_ASW_SLEW responsible for 72Hz requirement
|
* default of 0x02 in JBT_REG_ASW_SLEW responsible for 72Hz requirement
|
||||||
* to avoid red / blue flicker
|
* to avoid red / blue flicker
|
||||||
*/
|
*/
|
||||||
rc |= jbt_reg_write(jbt, JBT_REG_ASW_SLEW, 0x04);
|
rc |= jbt_reg_write(jbt, JBT_REG_ASW_SLEW, 0x04 | (1 << 5));
|
||||||
rc |= jbt_reg_write(jbt, JBT_REG_DUMMY_DISPLAY, 0x00);
|
rc |= jbt_reg_write(jbt, JBT_REG_DUMMY_DISPLAY, 0x00);
|
||||||
|
|
||||||
rc |= jbt_reg_write(jbt, JBT_REG_SLEEP_OUT_FR_A, 0x11);
|
rc |= jbt_reg_write(jbt, JBT_REG_SLEEP_OUT_FR_A, 0x11);
|
||||||
@ -319,11 +326,11 @@ static int normal_to_sleep(struct jbt_info *jbt)
|
|||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
/* Make sure we are 120 ms after SLEEP_OUT */
|
/* Make sure we are 120 ms after SLEEP_OUT */
|
||||||
if (time_before(jiffies, jbt->last_sleep))
|
while (time_before(jiffies, jbt->last_sleep))
|
||||||
mdelay(jiffies_to_msecs(jbt->last_sleep - jiffies));
|
cpu_relax();
|
||||||
|
|
||||||
rc = jbt_reg_write_nodata(jbt, JBT_REG_DISPLAY_OFF);
|
rc = jbt_reg_write_nodata(jbt, JBT_REG_DISPLAY_OFF);
|
||||||
rc |= jbt_reg_write16(jbt, JBT_REG_OUTPUT_CONTROL, 0x8002);
|
rc |= jbt_reg_write16(jbt, JBT_REG_OUTPUT_CONTROL, 0x8000 | 1 << 3);
|
||||||
rc |= jbt_reg_write_nodata(jbt, JBT_REG_SLEEP_IN);
|
rc |= jbt_reg_write_nodata(jbt, JBT_REG_SLEEP_IN);
|
||||||
jbt->last_sleep = jiffies + msecs_to_jiffies(120);
|
jbt->last_sleep = jiffies + msecs_to_jiffies(120);
|
||||||
|
|
||||||
@ -338,9 +345,9 @@ static int sleep_to_standby(struct jbt_info *jbt)
|
|||||||
return jbt_reg_write(jbt, JBT_REG_POWER_ON_OFF, 0x00);
|
return jbt_reg_write(jbt, JBT_REG_POWER_ON_OFF, 0x00);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* frontend function */
|
|
||||||
int jbt6k74_enter_power_mode(struct jbt_info *jbt, enum jbt_power_mode new_mode)
|
int jbt6k74_enter_power_mode(struct jbt_info *jbt, enum jbt_power_mode new_mode)
|
||||||
{
|
{
|
||||||
|
struct jbt6k74_platform_data *pdata = jbt->spi_dev->dev.platform_data;
|
||||||
int rc = -EINVAL;
|
int rc = -EINVAL;
|
||||||
|
|
||||||
dev_dbg(&jbt->spi_dev->dev, "entering (old_state=%s, new_state=%s)\n",
|
dev_dbg(&jbt->spi_dev->dev, "entering (old_state=%s, new_state=%s)\n",
|
||||||
@ -349,6 +356,22 @@ int jbt6k74_enter_power_mode(struct jbt_info *jbt, enum jbt_power_mode new_mode)
|
|||||||
|
|
||||||
mutex_lock(&jbt->lock);
|
mutex_lock(&jbt->lock);
|
||||||
|
|
||||||
|
if (jbt->suspended) {
|
||||||
|
switch (new_mode) {
|
||||||
|
case JBT_POWER_MODE_DEEP_STANDBY:
|
||||||
|
case JBT_POWER_MODE_SLEEP:
|
||||||
|
case JBT_POWER_MODE_NORMAL:
|
||||||
|
rc = 0;
|
||||||
|
jbt->suspend_mode = new_mode;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} else if (new_mode == JBT_POWER_MODE_NORMAL &&
|
||||||
|
pdata->enable_pixel_clock) {
|
||||||
|
pdata->enable_pixel_clock(&jbt->spi_dev->dev, 1);
|
||||||
|
}
|
||||||
|
|
||||||
switch (jbt->power_mode) {
|
switch (jbt->power_mode) {
|
||||||
case JBT_POWER_MODE_DEEP_STANDBY:
|
case JBT_POWER_MODE_DEEP_STANDBY:
|
||||||
switch (new_mode) {
|
switch (new_mode) {
|
||||||
@ -396,11 +419,15 @@ int jbt6k74_enter_power_mode(struct jbt_info *jbt, enum jbt_power_mode new_mode)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if (rc == 0)
|
if (rc == 0) {
|
||||||
jbt->power_mode = new_mode;
|
jbt->power_mode = new_mode;
|
||||||
else
|
if (new_mode != JBT_POWER_MODE_NORMAL &&
|
||||||
|
pdata->enable_pixel_clock)
|
||||||
|
pdata->enable_pixel_clock(&jbt->spi_dev->dev, 0);
|
||||||
|
} else {
|
||||||
dev_err(&jbt->spi_dev->dev, "Failed enter state '%s')\n",
|
dev_err(&jbt->spi_dev->dev, "Failed enter state '%s')\n",
|
||||||
jbt_power_mode_names[new_mode]);
|
jbt_power_mode_names[new_mode]);
|
||||||
|
}
|
||||||
|
|
||||||
mutex_unlock(&jbt->lock);
|
mutex_unlock(&jbt->lock);
|
||||||
|
|
||||||
@ -412,15 +439,15 @@ int jbt6k74_set_resolution(struct jbt_info *jbt, enum jbt_resolution new_resolut
|
|||||||
int rc = 0;
|
int rc = 0;
|
||||||
enum jbt_resolution old_resolution;
|
enum jbt_resolution old_resolution;
|
||||||
|
|
||||||
mutex_lock(&jbt->lock);
|
|
||||||
|
|
||||||
if (jbt->resolution == new_resolution)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (new_resolution != JBT_RESOLUTION_VGA &&
|
if (new_resolution != JBT_RESOLUTION_VGA &&
|
||||||
new_resolution != JBT_RESOLUTION_QVGA)
|
new_resolution != JBT_RESOLUTION_QVGA)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
|
mutex_lock(&jbt->lock);
|
||||||
|
|
||||||
|
if (jbt->resolution == new_resolution)
|
||||||
|
goto out_unlock;
|
||||||
|
|
||||||
old_resolution = jbt->resolution;
|
old_resolution = jbt->resolution;
|
||||||
jbt->resolution = new_resolution;
|
jbt->resolution = new_resolution;
|
||||||
|
|
||||||
@ -442,44 +469,13 @@ int jbt6k74_set_resolution(struct jbt_info *jbt, enum jbt_resolution new_resolut
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
out_unlock:
|
||||||
mutex_unlock(&jbt->lock);
|
mutex_unlock(&jbt->lock);
|
||||||
|
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(jbt6k74_set_resolution);
|
EXPORT_SYMBOL_GPL(jbt6k74_set_resolution);
|
||||||
|
|
||||||
static ssize_t power_mode_read(struct device *dev, struct device_attribute *attr,
|
|
||||||
char *buf)
|
|
||||||
{
|
|
||||||
struct jbt_info *jbt = dev_get_drvdata(dev);
|
|
||||||
|
|
||||||
if (jbt->power_mode >= ARRAY_SIZE(jbt_power_mode_names))
|
|
||||||
return -EIO;
|
|
||||||
|
|
||||||
return sprintf(buf, "%s\n", jbt_power_mode_names[jbt->power_mode]);
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t power_mode_write(struct device *dev, struct device_attribute *attr,
|
|
||||||
const char *buf, size_t count)
|
|
||||||
{
|
|
||||||
struct jbt_info *jbt = dev_get_drvdata(dev);
|
|
||||||
int i, rc;
|
|
||||||
|
|
||||||
for (i = 0; i < ARRAY_SIZE(jbt_power_mode_names); i++) {
|
|
||||||
if (!strncmp(buf, jbt_power_mode_names[i],
|
|
||||||
strlen(jbt_power_mode_names[i]))) {
|
|
||||||
rc = jbt6k74_enter_power_mode(jbt, i);
|
|
||||||
if (rc)
|
|
||||||
return rc;
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static DEVICE_ATTR(power_mode, 0644, power_mode_read, power_mode_write);
|
|
||||||
|
|
||||||
static ssize_t resolution_read(struct device *dev, struct device_attribute *attr,
|
static ssize_t resolution_read(struct device *dev, struct device_attribute *attr,
|
||||||
char *buf)
|
char *buf)
|
||||||
{
|
{
|
||||||
@ -533,7 +529,7 @@ static ssize_t gamma_read(struct device *dev, struct device_attribute *attr,
|
|||||||
|
|
||||||
mutex_lock(&jbt->lock);
|
mutex_lock(&jbt->lock);
|
||||||
val = jbt->reg_cache[reg];
|
val = jbt->reg_cache[reg];
|
||||||
mutex_unlock(&jbt->lock);
|
mutex_unlock(&jbt->lock);
|
||||||
|
|
||||||
return sprintf(buf, "0x%04x\n", val);
|
return sprintf(buf, "0x%04x\n", val);
|
||||||
}
|
}
|
||||||
@ -590,7 +586,6 @@ static DEVICE_ATTR(gamma_blue_offset, 0644, gamma_read, gamma_write);
|
|||||||
static DEVICE_ATTR(reset, 0600, NULL, reset_write);
|
static DEVICE_ATTR(reset, 0600, NULL, reset_write);
|
||||||
|
|
||||||
static struct attribute *jbt_sysfs_entries[] = {
|
static struct attribute *jbt_sysfs_entries[] = {
|
||||||
&dev_attr_power_mode.attr,
|
|
||||||
&dev_attr_resolution.attr,
|
&dev_attr_resolution.attr,
|
||||||
&dev_attr_gamma_fine1.attr,
|
&dev_attr_gamma_fine1.attr,
|
||||||
&dev_attr_gamma_fine2.attr,
|
&dev_attr_gamma_fine2.attr,
|
||||||
@ -605,61 +600,89 @@ static struct attribute_group jbt_attr_group = {
|
|||||||
.attrs = jbt_sysfs_entries,
|
.attrs = jbt_sysfs_entries,
|
||||||
};
|
};
|
||||||
|
|
||||||
static int fb_notifier_callback(struct notifier_block *self,
|
/* FIXME: This in an ugly hack to delay display blanking.
|
||||||
unsigned long event, void *data)
|
When the jbt is in sleep mode it displays an all white screen and thus one
|
||||||
{
|
will a see a short flash.
|
||||||
struct jbt_info *jbt;
|
By delaying the blanking we will give the backlight a chance to turn off and
|
||||||
struct fb_event *evdata = data;
|
thus avoid getting the flash */
|
||||||
struct fb_info *info;
|
static void jbt_blank_worker(struct work_struct *work) {
|
||||||
int fb_blank;
|
struct jbt_info *jbt = container_of(work, struct jbt_info,
|
||||||
|
blank_work.work);
|
||||||
|
|
||||||
jbt = container_of(self, struct jbt_info, fb_notif);
|
switch (jbt->blank_mode) {
|
||||||
|
case FB_BLANK_NORMAL:
|
||||||
dev_dbg(&jbt->spi_dev->dev, "event=%lu\n", event);
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_SLEEP);
|
||||||
|
|
||||||
switch (event) {
|
|
||||||
case FB_EVENT_MODE_CHANGE:
|
|
||||||
case FB_EVENT_MODE_CHANGE_ALL:
|
|
||||||
info = evdata->info;
|
|
||||||
if (info->var.xres == 240 &&
|
|
||||||
info->var.yres == 320) {
|
|
||||||
jbt6k74_set_resolution(jbt, JBT_RESOLUTION_QVGA);
|
|
||||||
} else if (info->var.xres == 480 &&
|
|
||||||
info->var.yres == 640) {
|
|
||||||
jbt6k74_set_resolution(jbt, JBT_RESOLUTION_VGA);
|
|
||||||
} else {
|
|
||||||
dev_err(&jbt->spi_dev->dev, "Unknown resolution. Entering sleep mode.\n");
|
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_SLEEP);
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
case FB_EVENT_BLANK:
|
case FB_BLANK_POWERDOWN:
|
||||||
case FB_EVENT_CONBLANK:
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
||||||
fb_blank = *(int *)evdata->data;
|
break;
|
||||||
switch (fb_blank) {
|
default:
|
||||||
case FB_BLANK_UNBLANK:
|
break;
|
||||||
dev_dbg(&jbt->spi_dev->dev, "unblank\n");
|
}
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
}
|
||||||
break;
|
|
||||||
case FB_BLANK_NORMAL:
|
static int jbt6k74_set_mode(struct lcd_device *ld, struct fb_videomode *m) {
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_SLEEP);
|
int rc = -EINVAL;
|
||||||
dev_dbg(&jbt->spi_dev->dev, "blank\n");
|
struct jbt_info *jbt = dev_get_drvdata(&ld->dev);
|
||||||
break;
|
|
||||||
case FB_BLANK_VSYNC_SUSPEND:
|
if (m->xres == 240 && m->yres == 320) {
|
||||||
dev_dbg(&jbt->spi_dev->dev, "vsync suspend\n");
|
rc = jbt6k74_set_resolution(jbt, JBT_RESOLUTION_QVGA);
|
||||||
break;
|
} else if (m->xres == 480 && m->yres == 640) {
|
||||||
case FB_BLANK_HSYNC_SUSPEND:
|
rc = jbt6k74_set_resolution(jbt, JBT_RESOLUTION_VGA);
|
||||||
dev_dbg(&jbt->spi_dev->dev, "hsync suspend\n");
|
} else {
|
||||||
break;
|
dev_err(&jbt->spi_dev->dev, "Unknown resolution. Entering sleep mode.\n");
|
||||||
case FB_BLANK_POWERDOWN:
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_SLEEP);
|
||||||
dev_dbg(&jbt->spi_dev->dev, "powerdown\n");
|
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int jbt6k74_set_power(struct lcd_device *ld, int power) {
|
||||||
|
int rc = -EINVAL;
|
||||||
|
struct jbt_info *jbt = dev_get_drvdata(&ld->dev);
|
||||||
|
|
||||||
|
jbt->blank_mode = power;
|
||||||
|
cancel_rearming_delayed_work(&jbt->blank_work);
|
||||||
|
|
||||||
|
switch (power) {
|
||||||
|
case FB_BLANK_UNBLANK:
|
||||||
|
dev_dbg(&jbt->spi_dev->dev, "unblank\n");
|
||||||
|
rc = jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
||||||
|
break;
|
||||||
|
case FB_BLANK_NORMAL:
|
||||||
|
dev_dbg(&jbt->spi_dev->dev, "blank\n");
|
||||||
|
rc = schedule_delayed_work(&jbt->blank_work, HZ);
|
||||||
|
break;
|
||||||
|
case FB_BLANK_POWERDOWN:
|
||||||
|
dev_dbg(&jbt->spi_dev->dev, "powerdown\n");
|
||||||
|
rc = schedule_delayed_work(&jbt->blank_work, HZ);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int jbt6k74_get_power(struct lcd_device *ld) {
|
||||||
|
struct jbt_info *jbt = dev_get_drvdata(&ld->dev);
|
||||||
|
|
||||||
|
switch (jbt->power_mode) {
|
||||||
|
case JBT_POWER_MODE_NORMAL:
|
||||||
|
return FB_BLANK_UNBLANK;
|
||||||
|
case JBT_POWER_MODE_SLEEP:
|
||||||
|
return FB_BLANK_NORMAL;
|
||||||
|
default:
|
||||||
|
return JBT_POWER_MODE_DEEP_STANDBY;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
struct lcd_ops jbt6k74_lcd_ops = {
|
||||||
|
.set_power = jbt6k74_set_power,
|
||||||
|
.get_power = jbt6k74_get_power,
|
||||||
|
.set_mode = jbt6k74_set_mode,
|
||||||
|
};
|
||||||
|
|
||||||
/* linux device model infrastructure */
|
/* linux device model infrastructure */
|
||||||
|
|
||||||
static int __devinit jbt_probe(struct spi_device *spi)
|
static int __devinit jbt_probe(struct spi_device *spi)
|
||||||
@ -685,6 +708,17 @@ static int __devinit jbt_probe(struct spi_device *spi)
|
|||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
jbt->spi_dev = spi;
|
jbt->spi_dev = spi;
|
||||||
|
|
||||||
|
jbt->lcd_dev = lcd_device_register("jbt6k74-lcd", &spi->dev,
|
||||||
|
jbt, &jbt6k74_lcd_ops);
|
||||||
|
|
||||||
|
if (IS_ERR(jbt->lcd_dev)) {
|
||||||
|
rc = PTR_ERR(jbt->lcd_dev);
|
||||||
|
goto err_free_drvdata;
|
||||||
|
}
|
||||||
|
|
||||||
|
INIT_DELAYED_WORK(&jbt->blank_work, jbt_blank_worker);
|
||||||
|
|
||||||
jbt->resolution = JBT_RESOLUTION_VGA;
|
jbt->resolution = JBT_RESOLUTION_VGA;
|
||||||
jbt->power_mode = JBT_POWER_MODE_DEEP_STANDBY;
|
jbt->power_mode = JBT_POWER_MODE_DEEP_STANDBY;
|
||||||
jbt->last_sleep = jiffies + msecs_to_jiffies(120);
|
jbt->last_sleep = jiffies + msecs_to_jiffies(120);
|
||||||
@ -695,7 +729,7 @@ static int __devinit jbt_probe(struct spi_device *spi)
|
|||||||
rc = jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
rc = jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
||||||
if (rc < 0) {
|
if (rc < 0) {
|
||||||
dev_err(&spi->dev, "cannot enter NORMAL state\n");
|
dev_err(&spi->dev, "cannot enter NORMAL state\n");
|
||||||
goto err_free_drvdata;
|
goto err_unregister_lcd;
|
||||||
}
|
}
|
||||||
|
|
||||||
rc = sysfs_create_group(&spi->dev.kobj, &jbt_attr_group);
|
rc = sysfs_create_group(&spi->dev.kobj, &jbt_attr_group);
|
||||||
@ -704,22 +738,15 @@ static int __devinit jbt_probe(struct spi_device *spi)
|
|||||||
goto err_standby;
|
goto err_standby;
|
||||||
}
|
}
|
||||||
|
|
||||||
jbt->fb_notif.notifier_call = fb_notifier_callback;
|
|
||||||
rc = fb_register_client(&jbt->fb_notif);
|
|
||||||
if (rc < 0) {
|
|
||||||
dev_err(&spi->dev, "cannot register notifier\n");
|
|
||||||
goto err_sysfs;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (pdata->probe_completed)
|
if (pdata->probe_completed)
|
||||||
(pdata->probe_completed)(&spi->dev);
|
(pdata->probe_completed)(&spi->dev);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err_sysfs:
|
|
||||||
sysfs_remove_group(&spi->dev.kobj, &jbt_attr_group);
|
|
||||||
err_standby:
|
err_standby:
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
||||||
|
err_unregister_lcd:
|
||||||
|
lcd_device_unregister(jbt->lcd_dev);
|
||||||
err_free_drvdata:
|
err_free_drvdata:
|
||||||
dev_set_drvdata(&spi->dev, NULL);
|
dev_set_drvdata(&spi->dev, NULL);
|
||||||
kfree(jbt);
|
kfree(jbt);
|
||||||
@ -732,12 +759,14 @@ static int __devexit jbt_remove(struct spi_device *spi)
|
|||||||
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
||||||
|
|
||||||
/* We don't want to switch off the display in case the user
|
/* We don't want to switch off the display in case the user
|
||||||
* accidentially onloads the module (whose use count normally is 0) */
|
* accidentially unloads the module (whose use count normally is 0) */
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_NORMAL);
|
||||||
|
|
||||||
fb_unregister_client(&jbt->fb_notif);
|
|
||||||
sysfs_remove_group(&spi->dev.kobj, &jbt_attr_group);
|
sysfs_remove_group(&spi->dev.kobj, &jbt_attr_group);
|
||||||
dev_set_drvdata(&spi->dev, NULL);
|
dev_set_drvdata(&spi->dev, NULL);
|
||||||
|
|
||||||
|
lcd_device_unregister(jbt->lcd_dev);
|
||||||
|
|
||||||
kfree(jbt);
|
kfree(jbt);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
@ -748,7 +777,10 @@ static int jbt_suspend(struct spi_device *spi, pm_message_t state)
|
|||||||
{
|
{
|
||||||
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
||||||
|
|
||||||
|
jbt->suspend_mode = jbt->power_mode;
|
||||||
|
|
||||||
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
jbt6k74_enter_power_mode(jbt, JBT_POWER_MODE_DEEP_STANDBY);
|
||||||
|
jbt->suspended = 1;
|
||||||
|
|
||||||
dev_info(&spi->dev, "suspended\n");
|
dev_info(&spi->dev, "suspended\n");
|
||||||
|
|
||||||
@ -758,12 +790,9 @@ static int jbt_suspend(struct spi_device *spi, pm_message_t state)
|
|||||||
int jbt6k74_resume(struct spi_device *spi)
|
int jbt6k74_resume(struct spi_device *spi)
|
||||||
{
|
{
|
||||||
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
struct jbt_info *jbt = dev_get_drvdata(&spi->dev);
|
||||||
struct jbt6k74_platform_data *pdata = spi->dev.platform_data;
|
|
||||||
|
|
||||||
jbt6k74_enter_power_mode(jbt, jbt->power_mode);
|
jbt->suspended = 0;
|
||||||
|
jbt6k74_enter_power_mode(jbt, jbt->suspend_mode);
|
||||||
if (pdata->resuming)
|
|
||||||
(pdata->resuming)(0);
|
|
||||||
|
|
||||||
dev_info(&spi->dev, "resumed\n");
|
dev_info(&spi->dev, "resumed\n");
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user