From mboxrd@z Thu Jan 1 00:00:00 1970 From: Bruno =?UTF-8?B?UHLDqW1vbnQ=?= Date: Sat, 20 Mar 2010 16:06:19 +0000 Subject: [PATCH v2 3/6] hid: add backlight support to PicoLCD device Message-Id: <20100320170619.4ae99546@neptune.home> List-Id: References: <20100320170014.440959a8@neptune.home> In-Reply-To: <20100320170014.440959a8@neptune.home> MIME-Version: 1.0 Content-Type: text/plain; charset="iso-8859-1" Content-Transfer-Encoding: quoted-printable To: Jiri Kosina Cc: linux-input@vger.kernel.org, linux-usb@vger.kernel.org, linux-fbdev@vger.kernel.org, linux-kernel@vger.kernel.org, "Rick L. Vinyard Jr." , Nicu Pavel , Oliver Neukum , Jaya Kumar , Richard Purdie Add backlight support to PicoLCD device. Backlight support depends on backlight class and is only being compiled if backlight class has been selected. Signed-off-by: Bruno Pr=C3=A9mont --- drivers/hid/Kconfig | 2 +- drivers/hid/hid-picolcd.c | 134 +++++++++++++++++++++++++++++++++++++++++= +++- 2 files changed, 134 insertions(+), 2 deletions(-) diff --git a/drivers/hid/Kconfig b/drivers/hid/Kconfig index a474bcd..5ec3cb7 100644 --- a/drivers/hid/Kconfig +++ b/drivers/hid/Kconfig @@ -243,8 +243,8 @@ config HID_PICOLCD - Keypad - Switching between Firmware and Flash mode - Framebuffer for monochrome 256x64 display + - Backlight control (needs CONFIG_BACKLIGHT_CLASS_DEVICE) Features that are not (yet) supported: - - Backlight control - Contrast control - IR - General purpose outputs diff --git a/drivers/hid/hid-picolcd.c b/drivers/hid/hid-picolcd.c index 0c1d293..06cf099 100644 --- a/drivers/hid/hid-picolcd.c +++ b/drivers/hid/hid-picolcd.c @@ -26,6 +26,7 @@ =20 #include #include +#include =20 #include #include @@ -182,6 +183,11 @@ struct picolcd_data { struct fb_info *fb_info; struct fb_deferred_io fb_defio; #endif /* CONFIG_FB */ +#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) || defined(CONFIG_BACKLIGHT_CLA= SS_DEVICE_MODULE) + struct backlight_device *backlight; + u8 lcd_brightness; + u8 lcd_power; +#endif /* CONFIG_BACKLIGHT_CLASS_DEVICE */ =20 /* Housekeeping stuff */ spinlock_t lock; @@ -641,7 +647,7 @@ static void picolcd_exit_framebuffer(struct picolcd_dat= a *data) kfree(fb_vbitmap); } =20 - +#define picolcd_fbinfo(d) (d)->fb_info #else static inline int picolcd_fb_reset(struct picolcd_data *data, int clear) { @@ -654,8 +660,118 @@ static inline int picolcd_init_framebuffer(struct pic= olcd_data *data) static void picolcd_exit_framebuffer(struct picolcd_data *data) { } +#define picolcd_fbinfo(d) NULL #endif /* CONFIG_FB */ =20 +#if defined(CONFIG_BACKLIGHT_CLASS_DEVICE) || defined(CONFIG_BACKLIGHT_CLA= SS_DEVICE_MODULE) +/* + * backlight class device + */ +static int picolcd_get_brightness(struct backlight_device *bdev) +{ + struct picolcd_data *data =3D bl_get_data(bdev); + return data->lcd_brightness; +} + +static int picolcd_set_brightness(struct backlight_device *bdev) +{ + struct picolcd_data *data =3D bl_get_data(bdev); + struct hid_report *report =3D picolcd_out_report(REPORT_BRIGHTNESS, data-= >hdev); + unsigned long flags; + + if (!report || report->maxfield !=3D 1 || report->field[0]->report_count = !=3D 1) + return -ENODEV; + + data->lcd_brightness =3D bdev->props.brightness & 0x0ff; + data->lcd_power =3D bdev->props.power; + spin_lock_irqsave(&data->lock, flags); + hid_set_field(report->field[0], 0, data->lcd_power =3D FB_BLANK_UNBLANK ?= data->lcd_brightness : 0); + usbhid_submit_report(data->hdev, report, USB_DIR_OUT); + spin_unlock_irqrestore(&data->lock, flags); + return 0; +} + +static int picolcd_check_bl_fb(struct backlight_device *bdev, struct fb_in= fo *fb) +{ + return fb && fb =3D picolcd_fbinfo((struct picolcd_data *)bl_get_data(bde= v)); +} + +static const struct backlight_ops picolcd_blops =3D { + .update_status =3D picolcd_set_brightness, + .get_brightness =3D picolcd_get_brightness, + .check_fb =3D picolcd_check_bl_fb, +}; + +static inline int picolcd_init_backlight(struct picolcd_data *data, struct= hid_report *report) +{ + struct device *dev =3D &data->hdev->dev; + struct backlight_device *bdev; + struct backlight_properties props; + if (!report) + return -ENODEV; + if (report->maxfield !=3D 1 || report->field[0]->report_count !=3D 1 || + report->field[0]->report_size !=3D 8) { + dev_err(dev, "unsupported BRIGHTNESS report"); + return -EINVAL; + } + + memset(&props, 0, sizeof(props)); + props.max_brightness =3D 0xff; + bdev =3D backlight_device_register(dev_name(dev), dev, data, &picolcd_blo= ps, &props); + if (IS_ERR(bdev)) { + dev_err(dev, "failed to register backlight\n"); + return PTR_ERR(bdev); + } + bdev->props.brightness =3D 0xff; + data->lcd_brightness =3D 0xff; + data->backlight =3D bdev; + picolcd_set_brightness(bdev); + return 0; +} + +static void picolcd_exit_backlight(struct picolcd_data *data) +{ + struct backlight_device *bdev =3D data->backlight; + + data->backlight =3D NULL; + if (bdev) + backlight_device_unregister(bdev); +} + +static inline int picolcd_resume_backlight(struct picolcd_data *data) +{ + if (!data->backlight) + return 0; + return picolcd_set_brightness(data->backlight); +} + +static void picolcd_suspend_backlight(struct picolcd_data *data) +{ + int bl_power =3D data->lcd_power; + if (!data->backlight) + return; + + data->backlight->props.power =3D FB_BLANK_POWERDOWN; + picolcd_set_brightness(data->backlight); + data->lcd_power =3D data->backlight->props.power =3D bl_power; +} +#else +static inline int picolcd_init_backlight(struct picolcd_data *data, struct= hid_report *report) +{ + return 0; +} +static inline void picolcd_exit_backlight(struct picolcd_data *data) +{ +} +static inline int picolcd_resume_backlight(struct picolcd_data *data) +{ + return 0; +} +static void picolcd_suspend_backlight(struct picolcd_data *data) +{ +} +#endif /* CONFIG_BACKLIGHT_CLASS_DEVICE */ + /* * input class device */ @@ -775,6 +891,7 @@ static int picolcd_reset(struct hid_device *hdev) return -EBUSY; } =20 + picolcd_resume_backlight(data); #if defined(CONFIG_FB) || defined(CONFIG_FB_MODULE) if (data->fb_info) schedule_delayed_work(&data->fb_info->deferred_work, 0); @@ -1365,12 +1482,17 @@ static int picolcd_raw_event(struct hid_device *hde= v, #ifdef CONFIG_PM static int picolcd_suspend(struct hid_device *hdev) { + picolcd_suspend_backlight(hid_get_drvdata(hdev)); dbg_hid(PICOLCD_NAME " device ready for suspend\n"); return 0; } =20 static int picolcd_resume(struct hid_device *hdev) { + int ret; + ret =3D picolcd_resume_backlight(hid_get_drvdata(hdev)); + if (ret) + dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret); return 0; } =20 @@ -1383,6 +1505,9 @@ static int picolcd_reset_resume(struct hid_device *hd= ev) ret =3D picolcd_fb_reset(hid_get_drvdata(hdev), 0); if (ret) dbg_hid(PICOLCD_NAME " restoring framebuffer content failed: %d\n", ret); + ret =3D picolcd_resume_backlight(hid_get_drvdata(hdev)); + if (ret) + dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret); return 0; } #endif @@ -1504,6 +1629,11 @@ static inline int picolcd_probe_lcd(struct hid_devic= e *hdev, struct picolcd_data if (error) goto err; =20 + /* Setup backlight class device */ + error =3D picolcd_init_backlight(data, picolcd_out_report(REPORT_BRIGHTNE= SS, hdev)); + if (error) + goto err; + #ifdef CONFIG_DEBUG_FS report =3D picolcd_out_report(REPORT_READ_MEMORY, hdev); if (report && report->maxfield =3D 1 && report->field[0]->report_size =3D= 8) @@ -1513,6 +1643,7 @@ static inline int picolcd_probe_lcd(struct hid_device= *hdev, struct picolcd_data #endif return 0; err: + picolcd_exit_backlight(data); picolcd_exit_framebuffer(data); picolcd_exit_cir(data); picolcd_exit_keys(data); @@ -1653,6 +1784,7 @@ static void picolcd_remove(struct hid_device *hdev) hid_hw_stop(hdev); =20 /* Clean up the framebuffer */ + picolcd_exit_backlight(data); picolcd_exit_framebuffer(data); /* Cleanup input */ picolcd_exit_cir(data); --=20 1.6.4.4