linux/tools/testing/selftests/ir/ir_loopback.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0
   2// test ir decoder
   3//
   4// Copyright (C) 2018 Sean Young <sean@mess.org>
   5
   6// When sending LIRC_MODE_SCANCODE, the IR will be encoded. rc-loopback
   7// will send this IR to the receiver side, where we try to read the decoded
   8// IR. Decoding happens in a separate kernel thread, so we will need to
   9// wait until that is scheduled, hence we use poll to check for read
  10// readiness.
  11
  12#include <linux/lirc.h>
  13#include <errno.h>
  14#include <stdio.h>
  15#include <stdlib.h>
  16#include <stdbool.h>
  17#include <string.h>
  18#include <unistd.h>
  19#include <poll.h>
  20#include <time.h>
  21#include <sys/types.h>
  22#include <sys/ioctl.h>
  23#include <dirent.h>
  24#include <sys/stat.h>
  25#include <fcntl.h>
  26#include "../kselftest.h"
  27
  28#define TEST_SCANCODES  10
  29#define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0]))
  30#define SYSFS_PATH_MAX 256
  31#define DNAME_PATH_MAX 256
  32
  33static const struct {
  34        enum rc_proto proto;
  35        const char *name;
  36        unsigned int mask;
  37        const char *decoder;
  38} protocols[] = {
  39        { RC_PROTO_RC5, "rc-5", 0x1f7f, "rc-5" },
  40        { RC_PROTO_RC5X_20, "rc-5x-20", 0x1f7f3f, "rc-5" },
  41        { RC_PROTO_RC5_SZ, "rc-5-sz", 0x2fff, "rc-5-sz" },
  42        { RC_PROTO_JVC, "jvc", 0xffff, "jvc" },
  43        { RC_PROTO_SONY12, "sony-12", 0x1f007f, "sony" },
  44        { RC_PROTO_SONY15, "sony-15", 0xff007f, "sony" },
  45        { RC_PROTO_SONY20, "sony-20", 0x1fff7f, "sony" },
  46        { RC_PROTO_NEC, "nec", 0xffff, "nec" },
  47        { RC_PROTO_NECX, "nec-x", 0xffffff, "nec" },
  48        { RC_PROTO_NEC32, "nec-32", 0xffffffff, "nec" },
  49        { RC_PROTO_SANYO, "sanyo", 0x1fffff, "sanyo" },
  50        { RC_PROTO_RC6_0, "rc-6-0", 0xffff, "rc-6" },
  51        { RC_PROTO_RC6_6A_20, "rc-6-6a-20", 0xfffff, "rc-6" },
  52        { RC_PROTO_RC6_6A_24, "rc-6-6a-24", 0xffffff, "rc-6" },
  53        { RC_PROTO_RC6_6A_32, "rc-6-6a-32", 0xffffffff, "rc-6" },
  54        { RC_PROTO_RC6_MCE, "rc-6-mce", 0x00007fff, "rc-6" },
  55        { RC_PROTO_SHARP, "sharp", 0x1fff, "sharp" },
  56        { RC_PROTO_IMON, "imon", 0x7fffffff, "imon" },
  57        { RC_PROTO_RCMM12, "rcmm-12", 0x00000fff, "rc-mm" },
  58        { RC_PROTO_RCMM24, "rcmm-24", 0x00ffffff, "rc-mm" },
  59        { RC_PROTO_RCMM32, "rcmm-32", 0xffffffff, "rc-mm" },
  60};
  61
  62int lirc_open(const char *rc)
  63{
  64        struct dirent *dent;
  65        char buf[SYSFS_PATH_MAX + DNAME_PATH_MAX];
  66        DIR *d;
  67        int fd;
  68
  69        snprintf(buf, sizeof(buf), "/sys/class/rc/%s", rc);
  70
  71        d = opendir(buf);
  72        if (!d)
  73                ksft_exit_fail_msg("cannot open %s: %m\n", buf);
  74
  75        while ((dent = readdir(d)) != NULL) {
  76                if (!strncmp(dent->d_name, "lirc", 4)) {
  77                        snprintf(buf, sizeof(buf), "/dev/%s", dent->d_name);
  78                        break;
  79                }
  80        }
  81
  82        if (!dent)
  83                ksft_exit_skip("cannot find lirc device for %s\n", rc);
  84
  85        closedir(d);
  86
  87        fd = open(buf, O_RDWR | O_NONBLOCK);
  88        if (fd == -1)
  89                ksft_exit_fail_msg("cannot open: %s: %m\n", buf);
  90
  91        return fd;
  92}
  93
  94int main(int argc, char **argv)
  95{
  96        unsigned int mode;
  97        char buf[100];
  98        int rlircfd, wlircfd, protocolfd, i, n;
  99
 100        srand(time(NULL));
 101
 102        if (argc != 3)
 103                ksft_exit_fail_msg("Usage: %s <write rcN> <read rcN>\n",
 104                                   argv[0]);
 105
 106        rlircfd = lirc_open(argv[2]);
 107        mode = LIRC_MODE_SCANCODE;
 108        if (ioctl(rlircfd, LIRC_SET_REC_MODE, &mode))
 109                ksft_exit_fail_msg("failed to set scancode rec mode %s: %m\n",
 110                                   argv[2]);
 111
 112        wlircfd = lirc_open(argv[1]);
 113        if (ioctl(wlircfd, LIRC_SET_SEND_MODE, &mode))
 114                ksft_exit_fail_msg("failed to set scancode send mode %s: %m\n",
 115                                   argv[1]);
 116
 117        snprintf(buf, sizeof(buf), "/sys/class/rc/%s/protocols", argv[2]);
 118        protocolfd = open(buf, O_WRONLY);
 119        if (protocolfd == -1)
 120                ksft_exit_fail_msg("failed to open %s: %m\n", buf);
 121
 122        printf("Sending IR on %s and receiving IR on %s.\n", argv[1], argv[2]);
 123
 124        for (i = 0; i < ARRAY_SIZE(protocols); i++) {
 125                if (write(protocolfd, protocols[i].decoder,
 126                          strlen(protocols[i].decoder)) == -1)
 127                        ksft_exit_fail_msg("failed to set write decoder\n");
 128
 129                printf("Testing protocol %s for decoder %s (%d/%d)...\n",
 130                       protocols[i].name, protocols[i].decoder,
 131                       i + 1, (int)ARRAY_SIZE(protocols));
 132
 133                for (n = 0; n < TEST_SCANCODES; n++) {
 134                        unsigned int scancode = rand() & protocols[i].mask;
 135                        unsigned int rc_proto = protocols[i].proto;
 136
 137                        if (rc_proto == RC_PROTO_RC6_MCE)
 138                                scancode |= 0x800f0000;
 139
 140                        if (rc_proto == RC_PROTO_NECX &&
 141                            (((scancode >> 16) ^ ~(scancode >> 8)) & 0xff) == 0)
 142                                continue;
 143
 144                        if (rc_proto == RC_PROTO_NEC32 &&
 145                            (((scancode >> 8) ^ ~scancode) & 0xff) == 0)
 146                                continue;
 147
 148                        if (rc_proto == RC_PROTO_RCMM32 &&
 149                            (scancode & 0x000c0000) != 0x000c0000 &&
 150                            scancode & 0x00008000)
 151                                continue;
 152
 153                        struct lirc_scancode lsc = {
 154                                .rc_proto = rc_proto,
 155                                .scancode = scancode
 156                        };
 157
 158                        printf("Testing scancode:%x\n", scancode);
 159
 160                        while (write(wlircfd, &lsc, sizeof(lsc)) < 0) {
 161                                if (errno == EINTR)
 162                                        continue;
 163
 164                                ksft_exit_fail_msg("failed to send ir: %m\n");
 165                        }
 166
 167                        struct pollfd pfd = { .fd = rlircfd, .events = POLLIN };
 168                        struct lirc_scancode lsc2;
 169
 170                        poll(&pfd, 1, 1000);
 171
 172                        bool decoded = true;
 173
 174                        while (read(rlircfd, &lsc2, sizeof(lsc2)) < 0) {
 175                                if (errno == EINTR)
 176                                        continue;
 177
 178                                ksft_test_result_error("no scancode decoded: %m\n");
 179                                decoded = false;
 180                                break;
 181                        }
 182
 183                        if (!decoded)
 184                                continue;
 185
 186                        if (lsc.rc_proto != lsc2.rc_proto)
 187                                ksft_test_result_error("decoded protocol is different: %d\n",
 188                                                       lsc2.rc_proto);
 189
 190                        else if (lsc.scancode != lsc2.scancode)
 191                                ksft_test_result_error("decoded scancode is different: %llx\n",
 192                                                       lsc2.scancode);
 193                        else
 194                                ksft_inc_pass_cnt();
 195                }
 196
 197                printf("OK\n");
 198        }
 199
 200        close(rlircfd);
 201        close(wlircfd);
 202        close(protocolfd);
 203
 204        if (ksft_get_fail_cnt() > 0)
 205                ksft_exit_fail();
 206        else
 207                ksft_exit_pass();
 208
 209        return 0;
 210}
 211