linux-loongson/drivers/input/rmi4/rmi_f1a.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2025 André Apitzsch <git@apitzsch.eu>
 */

#include <linux/input.h>
#include <linux/property.h>
#include "rmi_driver.h"

struct f1a_data {
	struct input_dev *input;

	u32 *keymap;
	unsigned int num_keys;
};

static int rmi_f1a_parse_device_properties(struct rmi_function *fn, struct f1a_data *f1a)
{
	static const char buttons_property[] = "linux,keycodes";
	struct device *dev = &fn->dev;
	u32 *buttonmap;
	int n_keys;
	int error;

	if (!device_property_present(dev, buttons_property))
		return 0;

	n_keys = device_property_count_u32(dev, buttons_property);
	if (n_keys <= 0) {
		error = n_keys < 0 ? n_keys : -EINVAL;
		dev_err(dev, "Invalid/malformed '%s' property: %d\n",
			buttons_property, error);
		return error;
	}

	buttonmap = devm_kmalloc_array(dev, n_keys, sizeof(*buttonmap),
				       GFP_KERNEL);
	if (!buttonmap)
		return -ENOMEM;

	error = device_property_read_u32_array(dev, buttons_property,
					       buttonmap, n_keys);
	if (error) {
		dev_err(dev, "Failed to parse '%s' property: %d\n",
			buttons_property, error);
		return error;
	}

	f1a->keymap = buttonmap;
	f1a->num_keys = n_keys;

	return 0;
}

static irqreturn_t rmi_f1a_attention(int irq, void *ctx)
{
	struct rmi_function *fn = ctx;
	struct f1a_data *f1a = dev_get_drvdata(&fn->dev);
	char button_bitmask;
	int key;
	int error;

	error = rmi_read_block(fn->rmi_dev, fn->fd.data_base_addr,
			       &button_bitmask, sizeof(button_bitmask));
	if (error) {
		dev_err(&fn->dev, "Failed to read object data. Code: %d.\n",
			error);
		return IRQ_RETVAL(error);
	}

	for (key = 0; key < f1a->num_keys; key++)
		input_report_key(f1a->input, f1a->keymap[key],
				 button_bitmask & BIT(key));

	return IRQ_HANDLED;
}

static int rmi_f1a_config(struct rmi_function *fn)
{
	struct f1a_data *f1a = dev_get_drvdata(&fn->dev);
	struct rmi_driver *drv = fn->rmi_dev->driver;

	if (f1a->num_keys)
		drv->set_irq_bits(fn->rmi_dev, fn->irq_mask);

	return 0;
}

static int rmi_f1a_initialize(struct rmi_function *fn, struct f1a_data *f1a)
{
	int error;
	int i;

	error = rmi_f1a_parse_device_properties(fn, f1a);
	if (error)
		return error;

	for (i = 0; i < f1a->num_keys; i++)
		input_set_capability(f1a->input, EV_KEY, f1a->keymap[i]);

	f1a->input->keycode = f1a->keymap;
	f1a->input->keycodemax = f1a->num_keys;
	f1a->input->keycodesize = sizeof(f1a->keymap[0]);

	return 0;
}

static int rmi_f1a_probe(struct rmi_function *fn)
{
	struct rmi_device *rmi_dev = fn->rmi_dev;
	struct rmi_driver_data *drv_data = dev_get_drvdata(&rmi_dev->dev);
	struct f1a_data *f1a;
	int error;

	if (!drv_data->input) {
		dev_info(&fn->dev, "F1A: no input device found, ignoring\n");
		return -ENXIO;
	}

	f1a = devm_kzalloc(&fn->dev, sizeof(*f1a), GFP_KERNEL);
	if (!f1a)
		return -ENOMEM;

	f1a->input = drv_data->input;

	error = rmi_f1a_initialize(fn, f1a);
	if (error)
		return error;

	dev_set_drvdata(&fn->dev, f1a);

	return 0;
}

struct rmi_function_handler rmi_f1a_handler = {
	.driver = {
		.name = "rmi4_f1a",
	},
	.func = 0x1a,
	.probe = rmi_f1a_probe,
	.config = rmi_f1a_config,
	.attention = rmi_f1a_attention,
};