~mil/ppbbq10

57c6ebc3a342bab91c97ade4742cdb39d8408b85 — arturo182 2 years ago f1460b0
Add backlight as its own device so it can be controlled over sysfs
1 files changed, 36 insertions(+), 7 deletions(-)

M bbq10pmod.c
M bbq10pmod.c => bbq10pmod.c +36 -7
@@ 1,3 1,4 @@
#include <linux/backlight.h>
#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/init.h>


@@ 5,6 6,7 @@
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/slab.h>
#include <linux/types.h>


@@ 123,7 125,7 @@ static int bbq10pmod_write_reg(struct bbq10pmod_data *drv_data, u8 reg)
	return 0;
}

static int bbq10pmod_write_data(struct bbq10pmod_data *drv_data, u8 reg, u8 *buf, u8 len)
static int bbq10pmod_write_data(struct bbq10pmod_data *drv_data, u8 reg, const u8 *buf, u8 len)
{
	struct i2c_client *client = drv_data->client;
	int error;


@@ 132,7 134,7 @@ static int bbq10pmod_write_data(struct bbq10pmod_data *drv_data, u8 reg, u8 *buf

	struct i2c_msg msgs[] = {
		{ .addr = client->addr, .flags = 0, .len = sizeof(u8), .buf = &reg, },
		{ .addr = client->addr, .flags = 0, .len = len, .buf = buf, },
		{ .addr = client->addr, .flags = 0, .len = len, .buf = (u8*)buf, },
	};

	error = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));


@@ 276,10 278,31 @@ static irqreturn_t bbq10pmod_irq_handler(int irq, void *dev_id)
	return IRQ_HANDLED;
}

static int bbq10pmod_backlight_update_status(struct backlight_device *bd)
{
	const struct backlight_properties *p = &bd->props;
	const u8 intensity = (p->power == FB_BLANK_UNBLANK) ? p->brightness : 0;
	struct bbq10pmod_data *drv_data = dev_get_drvdata(&bd->dev);

	return bbq10pmod_write_data(drv_data, REG_BKL, &intensity, sizeof(intensity));
}

static const struct backlight_ops backlight_ops = {
	.options		= BL_CORE_SUSPENDRESUME,
	.update_status	= bbq10pmod_backlight_update_status,
};

static struct backlight_properties backlight_props = {
	.type			= BACKLIGHT_PLATFORM,
	.max_brightness = 255,
	.brightness		= 127,
};

static int bbq10pmod_probe(struct i2c_client *client, const struct i2c_device_id *id)
{
	struct device *dev = &client->dev;
	struct bbq10pmod_data *drv_data;
	struct backlight_device *bd;
	struct input_dev *input;
	int error;
	int i;


@@ 304,17 327,23 @@ static int bbq10pmod_probe(struct i2c_client *client, const struct i2c_device_id

	printk("%s version: 0x%02X\n", __func__, reg);

	reg = 0x55; // TODO: make a sysfs device
	error = bbq10pmod_write_data(drv_data, REG_BKL, &reg, sizeof(reg));
	if (error)
		return -ENODEV;

	reg = CFG_OVERFLOW_ON | CFG_OVERFLOW_INT | CFG_CAPSLOCK_INT |
			CFG_NUMLOCK_INT | CFG_KEY_INT | CFG_REPORT_MODS;
	error = bbq10pmod_write_data(drv_data, REG_CFG, &reg, sizeof(reg));
	if (error)
		return -ENODEV;

	bd = devm_backlight_device_register(dev, client->name, dev,
					    drv_data,
					    &backlight_ops,
					    &backlight_props);
	if (IS_ERR(bd))
		return PTR_ERR(bd);

	error = backlight_update_status(bd);
	if (error)
		return -ENODEV;

	input = devm_input_allocate_device(dev);
	if (!input)
		return -ENOMEM;