+++ /dev/null
-/*
- * arch/ubicom32/mach-common/ubicom32hid.c
- * I2C driver for HID coprocessor found on some DPF implementations.
- *
- * (C) Copyright 2009, Ubicom, Inc.
- *
- * This file is part of the Ubicom32 Linux Kernel Port.
- *
- * The Ubicom32 Linux Kernel Port is free software: you can redistribute
- * it and/or modify it under the terms of the GNU General Public License
- * as published by the Free Software Foundation, either version 2 of the
- * License, or (at your option) any later version.
- *
- * The Ubicom32 Linux Kernel Port is distributed in the hope that it
- * will be useful, but WITHOUT ANY WARRANTY; without even the implied
- * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See
- * the GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with the Ubicom32 Linux Kernel Port. If not,
- * see <http://www.gnu.org/licenses/>.
- *
- * Ubicom32 implementation derived from (with many thanks):
- * arch/m68knommu
- * arch/blackfin
- * arch/parisc
- */
-
-#include <linux/module.h>
-#include <linux/init.h>
-#include <linux/gpio.h>
-#include <linux/delay.h>
-#include <linux/platform_device.h>
-#include <linux/i2c.h>
-#include <linux/backlight.h>
-#include <linux/fb.h>
-#include <linux/input.h>
-#include <linux/input-polldev.h>
-
-#include <asm/ubicom32hid.h>
-
-#define DRIVER_NAME "ubicom32hid"
-
-#ifdef DEBUG
-static int ubicom32hid_debug;
-#endif
-
-static const struct i2c_device_id ubicom32hid_id[] = {
- { DRIVER_NAME, },
- { }
-};
-MODULE_DEVICE_TABLE(i2c, ubicom32hid_id);
-
-/*
- * Define this to make IR checking strict, in general, it's not needed
- */
-#undef UBICOM32HID_STRICT_IR_CHECK
-
-#define UBICOM32HID_CMD_SET_PWM 0x01
-#define UBICOM32HID_CMD_SET_BL_EN 0x02
-#define UBICOM32HID_BL_EN_LOW 0x00
-#define UBICOM32HID_BL_EN_HIZ 0x01
-#define UBICOM32HID_BL_EN_HI 0x02
-#define UBICOM32HID_CMD_FLUSH 0x99
-#define UBICOM32HID_CMD_RESET 0x99
-#define UBICOM32HID_CMD_GET_IR_SWITCH 0xC0
-#define UBICOM32HID_CMD_GET_REVISION 0xfd
-#define UBICOM32HID_CMD_GET_DEVICE_ID 0xfe
-#define UBICOM32HID_CMD_GET_VERSION 0xff
-#define UBICOM32HID_DEVICE_ID 0x49
-
-#define UBICOM32HID_MAX_BRIGHTNESS_PWM 255
-
-/*
- * Data structure returned by the HID device
- */
-struct ubicom32hid_input_data {
- uint32_t ircmd;
- uint8_t sw_state;
- uint8_t sw_changed;
-};
-
-/*
- * Our private data
- */
-struct ubicom32hid_data {
- /*
- * Pointer to the platform data structure, we need the settings.
- */
- const struct ubicom32hid_platform_data *pdata;
-
- /*
- * Backlight device
- */
- struct backlight_device *bldev;
-
- /*
- * I2C client, for sending messages to the HID device
- */
- struct i2c_client *client;
-
- /*
- * Current intensity, used for get_intensity.
- */
- int cur_intensity;
-
- /*
- * Input subsystem
- * We won't register an input subsystem if there are no mappings.
- */
- struct input_polled_dev *poll_dev;
-};
-
-
-/*
- * ubicom32hid_set_intensity
- */
-static int ubicom32hid_set_intensity(struct backlight_device *bd)
-{
- struct ubicom32hid_data *ud =
- (struct ubicom32hid_data *)bl_get_data(bd);
- int intensity = bd->props.brightness;
- int reg;
- u8_t val;
- int ret;
-
- /*
- * If we're blanked the the intensity doesn't matter.
- */
- if ((bd->props.power != FB_BLANK_UNBLANK) ||
- (bd->props.fb_blank != FB_BLANK_UNBLANK)) {
- intensity = 0;
- }
-
- /*
- * Set the brightness based on the type of backlight
- */
- if (ud->pdata->type == UBICOM32HID_BL_TYPE_BINARY) {
- reg = UBICOM32HID_CMD_SET_BL_EN;
- if (intensity) {
- val = ud->pdata->invert
- ? UBICOM32HID_BL_EN_LOW : UBICOM32HID_BL_EN_HI;
- } else {
- val = ud->pdata->invert
- ? UBICOM32HID_BL_EN_HI : UBICOM32HID_BL_EN_LOW;
- }
- } else {
- reg = UBICOM32HID_CMD_SET_PWM;
- val = ud->pdata->invert
- ? (UBICOM32HID_MAX_BRIGHTNESS_PWM - intensity) :
- intensity;
- }
-
- /*
- * Send the command
- */
- ret = i2c_smbus_write_byte_data(ud->client, reg, val);
- if (ret < 0) {
- dev_warn(&ud->client->dev, "Unable to write backlight err=%d\n",
- ret);
- return ret;
- }
-
- ud->cur_intensity = intensity;
-
- return 0;
-}
-
-/*
- * ubicom32hid_get_intensity
- * Return the current intensity of the backlight.
- */
-static int ubicom32hid_get_intensity(struct backlight_device *bd)
-{
- struct ubicom32hid_data *ud =
- (struct ubicom32hid_data *)bl_get_data(bd);
-
- return ud->cur_intensity;
-}
-
-/*
- * ubicom32hid_verify_data
- * Verify the data to see if there is any action to be taken
- *
- * Returns 0 if no action is to be taken, non-zero otherwise
- */
-static int ubicom32hid_verify_data(struct ubicom32hid_data *ud,
- struct ubicom32hid_input_data *data)
-{
- uint8_t *ircmd = (uint8_t *)&(data->ircmd);
-
- /*
- * ircmd == DEADBEEF means ir queue is empty. Since this is a
- * meaningful code, that means the rest of the message is most likely
- * correct, so only process the data if the switch state has changed.
- */
- if (data->ircmd == 0xDEADBEEF) {
- return data->sw_changed != 0;
- }
-
- /*
- * We have an ircmd which is not empty:
- * Data[1] should be the complement of Data[0]
- */
- if (ircmd[0] != (u8_t)~ircmd[1]) {
- return 0;
- }
-
-#ifdef UBICOM32HID_STRICT_IR_CHECK
- /*
- * It seems that some remote controls don't follow the NEC protocol
- * properly, so only do this check if the remote does indeed follow the
- * spec. Data[3] should be the complement of Data[2]
- */
- if (ircmd[2] == (u8_t)~ircmd[3]) {
- return 1;
- }
-
- /*
- * For non-compliant remotes, check the system code according to what
- * they send.
- */
- if ((ircmd[2] != UBICOM32HID_IR_SYSTEM_CODE_CHECK) ||
- (ircmd[3] != UBICOM32HID_IR_SYSTEM_CODE)) {
- return 0;
- }
-#endif
-
- /*
- * Data checks out, process
- */
- return 1;
-}
-
-/*
- * ubicom32hid_poll_input
- * Poll the input from the HID device.
- */
-static void ubicom32hid_poll_input(struct input_polled_dev *dev)
-{
- struct ubicom32hid_data *ud = (struct ubicom32hid_data *)dev->private;
- const struct ubicom32hid_platform_data *pdata = ud->pdata;
- struct ubicom32hid_input_data data;
- struct input_dev *id = dev->input;
- int i;
- int sync_needed = 0;
- uint8_t cmd;
- int ret;
-
- /*
- * Flush the queue
- */
- cmd = UBICOM32HID_CMD_FLUSH;
- ret = i2c_master_send(ud->client, &cmd, 1);
- if (ret < 0) {
- return;
- }
-
- ret = i2c_smbus_read_i2c_block_data(
- ud->client, UBICOM32HID_CMD_GET_IR_SWITCH, 6, (void *)&data);
- if (ret < 0) {
- return;
- }
-
- /*
- * Verify the data to see if there is any action to be taken
- */
- if (!ubicom32hid_verify_data(ud, &data)) {
- return;
- }
-
-#ifdef DEBUG
- if (ubicom32hid_debug) {
- printk("Polled ircmd=%8x swstate=%2x swchanged=%2x\n",
- data.ircmd, data.sw_state, data.sw_changed);
- }
-#endif
-
- /*
- * Process changed switches
- */
- if (data.sw_changed) {
- const struct ubicom32hid_button *ub = pdata->buttons;
- for (i = 0; i < pdata->nbuttons; i++, ub++) {
- uint8_t mask = (1 << ub->bit);
- if (!(data.sw_changed & mask)) {
- continue;
- }
-
- sync_needed = 1;
- input_event(id, ub->type, ub->code,
- (data.sw_state & mask) ? 1 : 0);
- }
- }
- if (sync_needed) {
- input_sync(id);
- }
-
- /*
- * Process ir codes
- */
- if (data.ircmd != 0xDEADBEEF) {
- const struct ubicom32hid_ir *ui = pdata->ircodes;
- for (i = 0; i < pdata->nircodes; i++, ui++) {
- if (ui->ir_code == data.ircmd) {
- /*
- * Simulate a up/down event
- */
- input_event(id, ui->type, ui->code, 1);
- input_sync(id);
- input_event(id, ui->type, ui->code, 0);
- input_sync(id);
- }
- }
- }
-}
-
-
-/*
- * Backlight ops
- */
-static struct backlight_ops ubicom32hid_blops = {
- .get_brightness = ubicom32hid_get_intensity,
- .update_status = ubicom32hid_set_intensity,
-};
-
-/*
- * ubicom32hid_probe
- */
-static int ubicom32hid_probe(struct i2c_client *client,
- const struct i2c_device_id *id)
-{
- struct ubicom32hid_platform_data *pdata;
- struct ubicom32hid_data *ud;
- int ret;
- int i;
- u8 version[2];
- char buf[1];
-
- pdata = client->dev.platform_data;
- if (pdata == NULL) {
- return -ENODEV;
- }
-
- /*
- * See if we even have a device available before allocating memory.
- *
- * Hard reset the device
- */
- ret = gpio_request(pdata->gpio_reset, "ubicom32hid-reset");
- if (ret < 0) {
- return ret;
- }
- gpio_direction_output(pdata->gpio_reset, pdata->gpio_reset_polarity);
- udelay(100);
- gpio_set_value(pdata->gpio_reset, !pdata->gpio_reset_polarity);
- udelay(100);
-
- /*
- * soft reset the device. It sometimes takes a while to do this.
- */
- for (i = 0; i < 50; i++) {
- buf[0] = UBICOM32HID_CMD_RESET;
- ret = i2c_master_send(client, buf, 1);
- if (ret > 0) {
- break;
- }
- udelay(10000);
- }
- if (i == 50) {
- dev_warn(&client->dev, "Unable to reset device\n");
- goto fail;
- }
-
- ret = i2c_smbus_read_byte_data(client, UBICOM32HID_CMD_GET_DEVICE_ID);
- if (ret != UBICOM32HID_DEVICE_ID) {
- dev_warn(&client->dev, "Incorrect device id %02x\n", buf[0]);
- ret = -ENODEV;
- goto fail;
- }
-
- ret = i2c_smbus_read_byte_data(client, UBICOM32HID_CMD_GET_VERSION);
- if (ret < 0) {
- dev_warn(&client->dev, "Unable to get version\n");
- goto fail;
- }
- version[0] = ret;
-
- ret = i2c_smbus_read_byte_data(client, UBICOM32HID_CMD_GET_REVISION);
- if (ret < 0) {
- dev_warn(&client->dev, "Unable to get revision\n");
- goto fail;
- }
- version[1] = ret;
-
- /*
- * Allocate our private data
- */
- ud = kzalloc(sizeof(struct ubicom32hid_data), GFP_KERNEL);
- if (!ud) {
- ret = -ENOMEM;
- goto fail;
- }
- ud->pdata = pdata;
- ud->client = client;
-
- /*
- * Register our backlight device
- */
- ud->bldev = backlight_device_register(DRIVER_NAME, &client->dev,
- ud, &ubicom32hid_blops);
- if (IS_ERR(ud->bldev)) {
- ret = PTR_ERR(ud->bldev);
- goto fail2;
- }
- platform_set_drvdata(client, ud);
-
- /*
- * Start up the backlight with the requested intensity
- */
- ud->bldev->props.power = FB_BLANK_UNBLANK;
- ud->bldev->props.max_brightness =
- (pdata->type == UBICOM32HID_BL_TYPE_PWM) ?
- UBICOM32HID_MAX_BRIGHTNESS_PWM : 1;
- if (pdata->default_intensity < ud->bldev->props.max_brightness) {
- ud->bldev->props.brightness = pdata->default_intensity;
- } else {
- dev_warn(&client->dev, "Default brightness out of range, "
- "setting to max\n");
- ud->bldev->props.brightness = ud->bldev->props.max_brightness;
- }
-
- ubicom32hid_set_intensity(ud->bldev);
-
- /*
- * Check to see if we have any inputs
- */
- if (!pdata->nbuttons && !pdata->nircodes) {
- goto done;
- }
-
- /*
- * We have buttons or codes, we must register an input device
- */
- ud->poll_dev = input_allocate_polled_device();
- if (!ud->poll_dev) {
- ret = -ENOMEM;
- goto fail3;
- }
-
- /*
- * Setup the polling to default to 100ms
- */
- ud->poll_dev->poll = ubicom32hid_poll_input;
- ud->poll_dev->poll_interval =
- pdata->poll_interval ? pdata->poll_interval : 100;
- ud->poll_dev->private = ud;
-
- ud->poll_dev->input->name =
- pdata->input_name ? pdata->input_name : "Ubicom32HID";
- ud->poll_dev->input->phys = "ubicom32hid/input0";
- ud->poll_dev->input->dev.parent = &client->dev;
- ud->poll_dev->input->id.bustype = BUS_I2C;
-
- /*
- * Set the capabilities by running through the buttons and ir codes
- */
- for (i = 0; i < pdata->nbuttons; i++) {
- const struct ubicom32hid_button *ub = &pdata->buttons[i];
-
- input_set_capability(ud->poll_dev->input,
- ub->type ? ub->type : EV_KEY, ub->code);
- }
-
- for (i = 0; i < pdata->nircodes; i++) {
- const struct ubicom32hid_ir *ui = &pdata->ircodes[i];
-
- input_set_capability(ud->poll_dev->input,
- ui->type ? ui->type : EV_KEY, ui->code);
- }
-
- ret = input_register_polled_device(ud->poll_dev);
- if (ret) {
- goto fail3;
- }
-
-done:
- printk(KERN_INFO DRIVER_NAME ": enabled, version=%02x.%02x\n",
- version[0], version[1]);
-
- return 0;
-
-fail3:
- gpio_free(ud->pdata->gpio_reset);
- backlight_device_unregister(ud->bldev);
-fail2:
- kfree(ud);
-fail:
- gpio_free(pdata->gpio_reset);
- return ret;
-}
-
-/*
- * ubicom32hid_remove
- */
-static int ubicom32hid_remove(struct i2c_client *client)
-{
- struct ubicom32hid_data *ud =
- (struct ubicom32hid_data *)platform_get_drvdata(client);
-
- gpio_free(ud->pdata->gpio_reset);
-
- backlight_device_unregister(ud->bldev);
-
- if (ud->poll_dev) {
- input_unregister_polled_device(ud->poll_dev);
- input_free_polled_device(ud->poll_dev);
- }
-
- platform_set_drvdata(client, NULL);
-
- kfree(ud);
-
- return 0;
-}
-
-static struct i2c_driver ubicom32hid_driver = {
- .driver = {
- .name = DRIVER_NAME,
- .owner = THIS_MODULE,
- },
- .probe = ubicom32hid_probe,
- .remove = __exit_p(ubicom32hid_remove),
- .id_table = ubicom32hid_id,
-};
-
-/*
- * ubicom32hid_init
- */
-static int __init ubicom32hid_init(void)
-{
- return i2c_add_driver(&ubicom32hid_driver);
-}
-module_init(ubicom32hid_init);
-
-/*
- * ubicom32hid_exit
- */
-static void __exit ubicom32hid_exit(void)
-{
- i2c_del_driver(&ubicom32hid_driver);
-}
-module_exit(ubicom32hid_exit);
-
-MODULE_AUTHOR("Pat Tjin <@ubicom.com>")
-MODULE_DESCRIPTION("Ubicom HID driver");
-MODULE_LICENSE("GPL");
projects / openwrt.git / blobdiff