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