18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Loopback driver for rc-core,
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (c) 2010 David Härdeman <david@hardeman.nu>
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * This driver receives TX data and passes it back as RX data,
88c2ecf20Sopenharmony_ci * which is useful for (scripted) debugging of rc-core without
98c2ecf20Sopenharmony_ci * having to use actual hardware.
108c2ecf20Sopenharmony_ci */
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_ci#include <linux/device.h>
138c2ecf20Sopenharmony_ci#include <linux/module.h>
148c2ecf20Sopenharmony_ci#include <linux/sched.h>
158c2ecf20Sopenharmony_ci#include <linux/slab.h>
168c2ecf20Sopenharmony_ci#include <media/rc-core.h>
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci#define DRIVER_NAME	"rc-loopback"
198c2ecf20Sopenharmony_ci#define dprintk(x...)	if (debug) printk(KERN_INFO DRIVER_NAME ": " x)
208c2ecf20Sopenharmony_ci#define RXMASK_REGULAR	0x1
218c2ecf20Sopenharmony_ci#define RXMASK_LEARNING	0x2
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_cistatic bool debug;
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_cistruct loopback_dev {
268c2ecf20Sopenharmony_ci	struct rc_dev *dev;
278c2ecf20Sopenharmony_ci	u32 txmask;
288c2ecf20Sopenharmony_ci	u32 txcarrier;
298c2ecf20Sopenharmony_ci	u32 txduty;
308c2ecf20Sopenharmony_ci	bool idle;
318c2ecf20Sopenharmony_ci	bool learning;
328c2ecf20Sopenharmony_ci	bool carrierreport;
338c2ecf20Sopenharmony_ci	u32 rxcarriermin;
348c2ecf20Sopenharmony_ci	u32 rxcarriermax;
358c2ecf20Sopenharmony_ci};
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_cistatic struct loopback_dev loopdev;
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_cistatic int loop_set_tx_mask(struct rc_dev *dev, u32 mask)
408c2ecf20Sopenharmony_ci{
418c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
428c2ecf20Sopenharmony_ci
438c2ecf20Sopenharmony_ci	if ((mask & (RXMASK_REGULAR | RXMASK_LEARNING)) != mask) {
448c2ecf20Sopenharmony_ci		dprintk("invalid tx mask: %u\n", mask);
458c2ecf20Sopenharmony_ci		return 2;
468c2ecf20Sopenharmony_ci	}
478c2ecf20Sopenharmony_ci
488c2ecf20Sopenharmony_ci	dprintk("setting tx mask: %u\n", mask);
498c2ecf20Sopenharmony_ci	lodev->txmask = mask;
508c2ecf20Sopenharmony_ci	return 0;
518c2ecf20Sopenharmony_ci}
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_cistatic int loop_set_tx_carrier(struct rc_dev *dev, u32 carrier)
548c2ecf20Sopenharmony_ci{
558c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	dprintk("setting tx carrier: %u\n", carrier);
588c2ecf20Sopenharmony_ci	lodev->txcarrier = carrier;
598c2ecf20Sopenharmony_ci	return 0;
608c2ecf20Sopenharmony_ci}
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_cistatic int loop_set_tx_duty_cycle(struct rc_dev *dev, u32 duty_cycle)
638c2ecf20Sopenharmony_ci{
648c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	if (duty_cycle < 1 || duty_cycle > 99) {
678c2ecf20Sopenharmony_ci		dprintk("invalid duty cycle: %u\n", duty_cycle);
688c2ecf20Sopenharmony_ci		return -EINVAL;
698c2ecf20Sopenharmony_ci	}
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci	dprintk("setting duty cycle: %u\n", duty_cycle);
728c2ecf20Sopenharmony_ci	lodev->txduty = duty_cycle;
738c2ecf20Sopenharmony_ci	return 0;
748c2ecf20Sopenharmony_ci}
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_cistatic int loop_set_rx_carrier_range(struct rc_dev *dev, u32 min, u32 max)
778c2ecf20Sopenharmony_ci{
788c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_ci	if (min < 1 || min > max) {
818c2ecf20Sopenharmony_ci		dprintk("invalid rx carrier range %u to %u\n", min, max);
828c2ecf20Sopenharmony_ci		return -EINVAL;
838c2ecf20Sopenharmony_ci	}
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ci	dprintk("setting rx carrier range %u to %u\n", min, max);
868c2ecf20Sopenharmony_ci	lodev->rxcarriermin = min;
878c2ecf20Sopenharmony_ci	lodev->rxcarriermax = max;
888c2ecf20Sopenharmony_ci	return 0;
898c2ecf20Sopenharmony_ci}
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_cistatic int loop_tx_ir(struct rc_dev *dev, unsigned *txbuf, unsigned count)
928c2ecf20Sopenharmony_ci{
938c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
948c2ecf20Sopenharmony_ci	u32 rxmask;
958c2ecf20Sopenharmony_ci	unsigned i;
968c2ecf20Sopenharmony_ci	struct ir_raw_event rawir = {};
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci	if (lodev->txcarrier < lodev->rxcarriermin ||
998c2ecf20Sopenharmony_ci	    lodev->txcarrier > lodev->rxcarriermax) {
1008c2ecf20Sopenharmony_ci		dprintk("ignoring tx, carrier out of range\n");
1018c2ecf20Sopenharmony_ci		goto out;
1028c2ecf20Sopenharmony_ci	}
1038c2ecf20Sopenharmony_ci
1048c2ecf20Sopenharmony_ci	if (lodev->learning)
1058c2ecf20Sopenharmony_ci		rxmask = RXMASK_LEARNING;
1068c2ecf20Sopenharmony_ci	else
1078c2ecf20Sopenharmony_ci		rxmask = RXMASK_REGULAR;
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci	if (!(rxmask & lodev->txmask)) {
1108c2ecf20Sopenharmony_ci		dprintk("ignoring tx, rx mask mismatch\n");
1118c2ecf20Sopenharmony_ci		goto out;
1128c2ecf20Sopenharmony_ci	}
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_ci	for (i = 0; i < count; i++) {
1158c2ecf20Sopenharmony_ci		rawir.pulse = i % 2 ? false : true;
1168c2ecf20Sopenharmony_ci		rawir.duration = txbuf[i];
1178c2ecf20Sopenharmony_ci		if (rawir.duration)
1188c2ecf20Sopenharmony_ci			ir_raw_event_store_with_filter(dev, &rawir);
1198c2ecf20Sopenharmony_ci	}
1208c2ecf20Sopenharmony_ci
1218c2ecf20Sopenharmony_ci	/* Fake a silence long enough to cause us to go idle */
1228c2ecf20Sopenharmony_ci	rawir.pulse = false;
1238c2ecf20Sopenharmony_ci	rawir.duration = dev->timeout;
1248c2ecf20Sopenharmony_ci	ir_raw_event_store_with_filter(dev, &rawir);
1258c2ecf20Sopenharmony_ci
1268c2ecf20Sopenharmony_ci	ir_raw_event_handle(dev);
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ciout:
1298c2ecf20Sopenharmony_ci	return count;
1308c2ecf20Sopenharmony_ci}
1318c2ecf20Sopenharmony_ci
1328c2ecf20Sopenharmony_cistatic void loop_set_idle(struct rc_dev *dev, bool enable)
1338c2ecf20Sopenharmony_ci{
1348c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	if (lodev->idle != enable) {
1378c2ecf20Sopenharmony_ci		dprintk("%sing idle mode\n", enable ? "enter" : "exit");
1388c2ecf20Sopenharmony_ci		lodev->idle = enable;
1398c2ecf20Sopenharmony_ci	}
1408c2ecf20Sopenharmony_ci}
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_cistatic int loop_set_learning_mode(struct rc_dev *dev, int enable)
1438c2ecf20Sopenharmony_ci{
1448c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci	if (lodev->learning != enable) {
1478c2ecf20Sopenharmony_ci		dprintk("%sing learning mode\n", enable ? "enter" : "exit");
1488c2ecf20Sopenharmony_ci		lodev->learning = !!enable;
1498c2ecf20Sopenharmony_ci	}
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ci	return 0;
1528c2ecf20Sopenharmony_ci}
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_cistatic int loop_set_carrier_report(struct rc_dev *dev, int enable)
1558c2ecf20Sopenharmony_ci{
1568c2ecf20Sopenharmony_ci	struct loopback_dev *lodev = dev->priv;
1578c2ecf20Sopenharmony_ci
1588c2ecf20Sopenharmony_ci	if (lodev->carrierreport != enable) {
1598c2ecf20Sopenharmony_ci		dprintk("%sabling carrier reports\n", enable ? "en" : "dis");
1608c2ecf20Sopenharmony_ci		lodev->carrierreport = !!enable;
1618c2ecf20Sopenharmony_ci	}
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_ci	return 0;
1648c2ecf20Sopenharmony_ci}
1658c2ecf20Sopenharmony_ci
1668c2ecf20Sopenharmony_cistatic int loop_set_wakeup_filter(struct rc_dev *dev,
1678c2ecf20Sopenharmony_ci				  struct rc_scancode_filter *sc)
1688c2ecf20Sopenharmony_ci{
1698c2ecf20Sopenharmony_ci	static const unsigned int max = 512;
1708c2ecf20Sopenharmony_ci	struct ir_raw_event *raw;
1718c2ecf20Sopenharmony_ci	int ret;
1728c2ecf20Sopenharmony_ci	int i;
1738c2ecf20Sopenharmony_ci
1748c2ecf20Sopenharmony_ci	/* fine to disable filter */
1758c2ecf20Sopenharmony_ci	if (!sc->mask)
1768c2ecf20Sopenharmony_ci		return 0;
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci	/* encode the specified filter and loop it back */
1798c2ecf20Sopenharmony_ci	raw = kmalloc_array(max, sizeof(*raw), GFP_KERNEL);
1808c2ecf20Sopenharmony_ci	if (!raw)
1818c2ecf20Sopenharmony_ci		return -ENOMEM;
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_ci	ret = ir_raw_encode_scancode(dev->wakeup_protocol, sc->data, raw, max);
1848c2ecf20Sopenharmony_ci	/* still loop back the partial raw IR even if it's incomplete */
1858c2ecf20Sopenharmony_ci	if (ret == -ENOBUFS)
1868c2ecf20Sopenharmony_ci		ret = max;
1878c2ecf20Sopenharmony_ci	if (ret >= 0) {
1888c2ecf20Sopenharmony_ci		/* do the loopback */
1898c2ecf20Sopenharmony_ci		for (i = 0; i < ret; ++i)
1908c2ecf20Sopenharmony_ci			ir_raw_event_store(dev, &raw[i]);
1918c2ecf20Sopenharmony_ci		ir_raw_event_handle(dev);
1928c2ecf20Sopenharmony_ci
1938c2ecf20Sopenharmony_ci		ret = 0;
1948c2ecf20Sopenharmony_ci	}
1958c2ecf20Sopenharmony_ci
1968c2ecf20Sopenharmony_ci	kfree(raw);
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci	return ret;
1998c2ecf20Sopenharmony_ci}
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_cistatic int __init loop_init(void)
2028c2ecf20Sopenharmony_ci{
2038c2ecf20Sopenharmony_ci	struct rc_dev *rc;
2048c2ecf20Sopenharmony_ci	int ret;
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_ci	rc = rc_allocate_device(RC_DRIVER_IR_RAW);
2078c2ecf20Sopenharmony_ci	if (!rc) {
2088c2ecf20Sopenharmony_ci		printk(KERN_ERR DRIVER_NAME ": rc_dev allocation failed\n");
2098c2ecf20Sopenharmony_ci		return -ENOMEM;
2108c2ecf20Sopenharmony_ci	}
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	rc->device_name		= "rc-core loopback device";
2138c2ecf20Sopenharmony_ci	rc->input_phys		= "rc-core/virtual";
2148c2ecf20Sopenharmony_ci	rc->input_id.bustype	= BUS_VIRTUAL;
2158c2ecf20Sopenharmony_ci	rc->input_id.version	= 1;
2168c2ecf20Sopenharmony_ci	rc->driver_name		= DRIVER_NAME;
2178c2ecf20Sopenharmony_ci	rc->map_name		= RC_MAP_EMPTY;
2188c2ecf20Sopenharmony_ci	rc->priv		= &loopdev;
2198c2ecf20Sopenharmony_ci	rc->allowed_protocols	= RC_PROTO_BIT_ALL_IR_DECODER;
2208c2ecf20Sopenharmony_ci	rc->allowed_wakeup_protocols = RC_PROTO_BIT_ALL_IR_ENCODER;
2218c2ecf20Sopenharmony_ci	rc->encode_wakeup	= true;
2228c2ecf20Sopenharmony_ci	rc->timeout		= MS_TO_US(100); /* 100 ms */
2238c2ecf20Sopenharmony_ci	rc->min_timeout		= 1;
2248c2ecf20Sopenharmony_ci	rc->max_timeout		= UINT_MAX;
2258c2ecf20Sopenharmony_ci	rc->rx_resolution	= 1;
2268c2ecf20Sopenharmony_ci	rc->tx_resolution	= 1;
2278c2ecf20Sopenharmony_ci	rc->s_tx_mask		= loop_set_tx_mask;
2288c2ecf20Sopenharmony_ci	rc->s_tx_carrier	= loop_set_tx_carrier;
2298c2ecf20Sopenharmony_ci	rc->s_tx_duty_cycle	= loop_set_tx_duty_cycle;
2308c2ecf20Sopenharmony_ci	rc->s_rx_carrier_range	= loop_set_rx_carrier_range;
2318c2ecf20Sopenharmony_ci	rc->tx_ir		= loop_tx_ir;
2328c2ecf20Sopenharmony_ci	rc->s_idle		= loop_set_idle;
2338c2ecf20Sopenharmony_ci	rc->s_learning_mode	= loop_set_learning_mode;
2348c2ecf20Sopenharmony_ci	rc->s_carrier_report	= loop_set_carrier_report;
2358c2ecf20Sopenharmony_ci	rc->s_wakeup_filter	= loop_set_wakeup_filter;
2368c2ecf20Sopenharmony_ci
2378c2ecf20Sopenharmony_ci	loopdev.txmask		= RXMASK_REGULAR;
2388c2ecf20Sopenharmony_ci	loopdev.txcarrier	= 36000;
2398c2ecf20Sopenharmony_ci	loopdev.txduty		= 50;
2408c2ecf20Sopenharmony_ci	loopdev.rxcarriermin	= 1;
2418c2ecf20Sopenharmony_ci	loopdev.rxcarriermax	= ~0;
2428c2ecf20Sopenharmony_ci	loopdev.idle		= true;
2438c2ecf20Sopenharmony_ci	loopdev.learning	= false;
2448c2ecf20Sopenharmony_ci	loopdev.carrierreport	= false;
2458c2ecf20Sopenharmony_ci
2468c2ecf20Sopenharmony_ci	ret = rc_register_device(rc);
2478c2ecf20Sopenharmony_ci	if (ret < 0) {
2488c2ecf20Sopenharmony_ci		printk(KERN_ERR DRIVER_NAME ": rc_dev registration failed\n");
2498c2ecf20Sopenharmony_ci		rc_free_device(rc);
2508c2ecf20Sopenharmony_ci		return ret;
2518c2ecf20Sopenharmony_ci	}
2528c2ecf20Sopenharmony_ci
2538c2ecf20Sopenharmony_ci	loopdev.dev = rc;
2548c2ecf20Sopenharmony_ci	return 0;
2558c2ecf20Sopenharmony_ci}
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_cistatic void __exit loop_exit(void)
2588c2ecf20Sopenharmony_ci{
2598c2ecf20Sopenharmony_ci	rc_unregister_device(loopdev.dev);
2608c2ecf20Sopenharmony_ci}
2618c2ecf20Sopenharmony_ci
2628c2ecf20Sopenharmony_cimodule_init(loop_init);
2638c2ecf20Sopenharmony_cimodule_exit(loop_exit);
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_cimodule_param(debug, bool, S_IRUGO | S_IWUSR);
2668c2ecf20Sopenharmony_ciMODULE_PARM_DESC(debug, "Enable debug messages");
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Loopback device for rc-core debugging");
2698c2ecf20Sopenharmony_ciMODULE_AUTHOR("David Härdeman <david@hardeman.nu>");
2708c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
271