|
| 1 | +// SPDX-License-Identifier: GPL-2.0 |
| 2 | +// bpf-lirc.c - handles bpf |
| 3 | +// |
| 4 | +// Copyright (C) 2018 Sean Young <[email protected]> |
| 5 | + |
| 6 | +#include <linux/bpf.h> |
| 7 | +#include <linux/filter.h> |
| 8 | +#include <linux/bpf_lirc.h> |
| 9 | +#include "rc-core-priv.h" |
| 10 | + |
| 11 | +/* |
| 12 | + * BPF interface for raw IR |
| 13 | + */ |
| 14 | +const struct bpf_prog_ops lirc_mode2_prog_ops = { |
| 15 | +}; |
| 16 | + |
| 17 | +BPF_CALL_1(bpf_rc_repeat, u32*, sample) |
| 18 | +{ |
| 19 | + struct ir_raw_event_ctrl *ctrl; |
| 20 | + |
| 21 | + ctrl = container_of(sample, struct ir_raw_event_ctrl, bpf_sample); |
| 22 | + |
| 23 | + rc_repeat(ctrl->dev); |
| 24 | + |
| 25 | + return 0; |
| 26 | +} |
| 27 | + |
| 28 | +static const struct bpf_func_proto rc_repeat_proto = { |
| 29 | + .func = bpf_rc_repeat, |
| 30 | + .gpl_only = true, /* rc_repeat is EXPORT_SYMBOL_GPL */ |
| 31 | + .ret_type = RET_INTEGER, |
| 32 | + .arg1_type = ARG_PTR_TO_CTX, |
| 33 | +}; |
| 34 | + |
| 35 | +/* |
| 36 | + * Currently rc-core does not support 64-bit scancodes, but there are many |
| 37 | + * known protocols with more than 32 bits. So, define the interface as u64 |
| 38 | + * as a future-proof. |
| 39 | + */ |
| 40 | +BPF_CALL_4(bpf_rc_keydown, u32*, sample, u32, protocol, u64, scancode, |
| 41 | + u32, toggle) |
| 42 | +{ |
| 43 | + struct ir_raw_event_ctrl *ctrl; |
| 44 | + |
| 45 | + ctrl = container_of(sample, struct ir_raw_event_ctrl, bpf_sample); |
| 46 | + |
| 47 | + rc_keydown(ctrl->dev, protocol, scancode, toggle != 0); |
| 48 | + |
| 49 | + return 0; |
| 50 | +} |
| 51 | + |
| 52 | +static const struct bpf_func_proto rc_keydown_proto = { |
| 53 | + .func = bpf_rc_keydown, |
| 54 | + .gpl_only = true, /* rc_keydown is EXPORT_SYMBOL_GPL */ |
| 55 | + .ret_type = RET_INTEGER, |
| 56 | + .arg1_type = ARG_PTR_TO_CTX, |
| 57 | + .arg2_type = ARG_ANYTHING, |
| 58 | + .arg3_type = ARG_ANYTHING, |
| 59 | + .arg4_type = ARG_ANYTHING, |
| 60 | +}; |
| 61 | + |
| 62 | +static const struct bpf_func_proto * |
| 63 | +lirc_mode2_func_proto(enum bpf_func_id func_id, const struct bpf_prog *prog) |
| 64 | +{ |
| 65 | + switch (func_id) { |
| 66 | + case BPF_FUNC_rc_repeat: |
| 67 | + return &rc_repeat_proto; |
| 68 | + case BPF_FUNC_rc_keydown: |
| 69 | + return &rc_keydown_proto; |
| 70 | + case BPF_FUNC_map_lookup_elem: |
| 71 | + return &bpf_map_lookup_elem_proto; |
| 72 | + case BPF_FUNC_map_update_elem: |
| 73 | + return &bpf_map_update_elem_proto; |
| 74 | + case BPF_FUNC_map_delete_elem: |
| 75 | + return &bpf_map_delete_elem_proto; |
| 76 | + case BPF_FUNC_ktime_get_ns: |
| 77 | + return &bpf_ktime_get_ns_proto; |
| 78 | + case BPF_FUNC_tail_call: |
| 79 | + return &bpf_tail_call_proto; |
| 80 | + case BPF_FUNC_get_prandom_u32: |
| 81 | + return &bpf_get_prandom_u32_proto; |
| 82 | + case BPF_FUNC_trace_printk: |
| 83 | + if (capable(CAP_SYS_ADMIN)) |
| 84 | + return bpf_get_trace_printk_proto(); |
| 85 | + /* fall through */ |
| 86 | + default: |
| 87 | + return NULL; |
| 88 | + } |
| 89 | +} |
| 90 | + |
| 91 | +static bool lirc_mode2_is_valid_access(int off, int size, |
| 92 | + enum bpf_access_type type, |
| 93 | + const struct bpf_prog *prog, |
| 94 | + struct bpf_insn_access_aux *info) |
| 95 | +{ |
| 96 | + /* We have one field of u32 */ |
| 97 | + return type == BPF_READ && off == 0 && size == sizeof(u32); |
| 98 | +} |
| 99 | + |
| 100 | +const struct bpf_verifier_ops lirc_mode2_verifier_ops = { |
| 101 | + .get_func_proto = lirc_mode2_func_proto, |
| 102 | + .is_valid_access = lirc_mode2_is_valid_access |
| 103 | +}; |
| 104 | + |
| 105 | +#define BPF_MAX_PROGS 64 |
| 106 | + |
| 107 | +static int lirc_bpf_attach(struct rc_dev *rcdev, struct bpf_prog *prog) |
| 108 | +{ |
| 109 | + struct bpf_prog_array __rcu *old_array; |
| 110 | + struct bpf_prog_array *new_array; |
| 111 | + struct ir_raw_event_ctrl *raw; |
| 112 | + int ret; |
| 113 | + |
| 114 | + if (rcdev->driver_type != RC_DRIVER_IR_RAW) |
| 115 | + return -EINVAL; |
| 116 | + |
| 117 | + ret = mutex_lock_interruptible(&ir_raw_handler_lock); |
| 118 | + if (ret) |
| 119 | + return ret; |
| 120 | + |
| 121 | + raw = rcdev->raw; |
| 122 | + if (!raw) { |
| 123 | + ret = -ENODEV; |
| 124 | + goto unlock; |
| 125 | + } |
| 126 | + |
| 127 | + if (raw->progs && bpf_prog_array_length(raw->progs) >= BPF_MAX_PROGS) { |
| 128 | + ret = -E2BIG; |
| 129 | + goto unlock; |
| 130 | + } |
| 131 | + |
| 132 | + old_array = raw->progs; |
| 133 | + ret = bpf_prog_array_copy(old_array, NULL, prog, &new_array); |
| 134 | + if (ret < 0) |
| 135 | + goto unlock; |
| 136 | + |
| 137 | + rcu_assign_pointer(raw->progs, new_array); |
| 138 | + bpf_prog_array_free(old_array); |
| 139 | + |
| 140 | +unlock: |
| 141 | + mutex_unlock(&ir_raw_handler_lock); |
| 142 | + return ret; |
| 143 | +} |
| 144 | + |
| 145 | +static int lirc_bpf_detach(struct rc_dev *rcdev, struct bpf_prog *prog) |
| 146 | +{ |
| 147 | + struct bpf_prog_array __rcu *old_array; |
| 148 | + struct bpf_prog_array *new_array; |
| 149 | + struct ir_raw_event_ctrl *raw; |
| 150 | + int ret; |
| 151 | + |
| 152 | + if (rcdev->driver_type != RC_DRIVER_IR_RAW) |
| 153 | + return -EINVAL; |
| 154 | + |
| 155 | + ret = mutex_lock_interruptible(&ir_raw_handler_lock); |
| 156 | + if (ret) |
| 157 | + return ret; |
| 158 | + |
| 159 | + raw = rcdev->raw; |
| 160 | + if (!raw) { |
| 161 | + ret = -ENODEV; |
| 162 | + goto unlock; |
| 163 | + } |
| 164 | + |
| 165 | + old_array = raw->progs; |
| 166 | + ret = bpf_prog_array_copy(old_array, prog, NULL, &new_array); |
| 167 | + /* |
| 168 | + * Do not use bpf_prog_array_delete_safe() as we would end up |
| 169 | + * with a dummy entry in the array, and the we would free the |
| 170 | + * dummy in lirc_bpf_free() |
| 171 | + */ |
| 172 | + if (ret) |
| 173 | + goto unlock; |
| 174 | + |
| 175 | + rcu_assign_pointer(raw->progs, new_array); |
| 176 | + bpf_prog_array_free(old_array); |
| 177 | +unlock: |
| 178 | + mutex_unlock(&ir_raw_handler_lock); |
| 179 | + return ret; |
| 180 | +} |
| 181 | + |
| 182 | +void lirc_bpf_run(struct rc_dev *rcdev, u32 sample) |
| 183 | +{ |
| 184 | + struct ir_raw_event_ctrl *raw = rcdev->raw; |
| 185 | + |
| 186 | + raw->bpf_sample = sample; |
| 187 | + |
| 188 | + if (raw->progs) |
| 189 | + BPF_PROG_RUN_ARRAY(raw->progs, &raw->bpf_sample, BPF_PROG_RUN); |
| 190 | +} |
| 191 | + |
| 192 | +/* |
| 193 | + * This should be called once the rc thread has been stopped, so there can be |
| 194 | + * no concurrent bpf execution. |
| 195 | + */ |
| 196 | +void lirc_bpf_free(struct rc_dev *rcdev) |
| 197 | +{ |
| 198 | + struct bpf_prog **progs; |
| 199 | + |
| 200 | + if (!rcdev->raw->progs) |
| 201 | + return; |
| 202 | + |
| 203 | + progs = rcu_dereference(rcdev->raw->progs)->progs; |
| 204 | + while (*progs) |
| 205 | + bpf_prog_put(*progs++); |
| 206 | + |
| 207 | + bpf_prog_array_free(rcdev->raw->progs); |
| 208 | +} |
| 209 | + |
| 210 | +int lirc_prog_attach(const union bpf_attr *attr) |
| 211 | +{ |
| 212 | + struct bpf_prog *prog; |
| 213 | + struct rc_dev *rcdev; |
| 214 | + int ret; |
| 215 | + |
| 216 | + if (attr->attach_flags) |
| 217 | + return -EINVAL; |
| 218 | + |
| 219 | + prog = bpf_prog_get_type(attr->attach_bpf_fd, |
| 220 | + BPF_PROG_TYPE_LIRC_MODE2); |
| 221 | + if (IS_ERR(prog)) |
| 222 | + return PTR_ERR(prog); |
| 223 | + |
| 224 | + rcdev = rc_dev_get_from_fd(attr->target_fd); |
| 225 | + if (IS_ERR(rcdev)) { |
| 226 | + bpf_prog_put(prog); |
| 227 | + return PTR_ERR(rcdev); |
| 228 | + } |
| 229 | + |
| 230 | + ret = lirc_bpf_attach(rcdev, prog); |
| 231 | + if (ret) |
| 232 | + bpf_prog_put(prog); |
| 233 | + |
| 234 | + put_device(&rcdev->dev); |
| 235 | + |
| 236 | + return ret; |
| 237 | +} |
| 238 | + |
| 239 | +int lirc_prog_detach(const union bpf_attr *attr) |
| 240 | +{ |
| 241 | + struct bpf_prog *prog; |
| 242 | + struct rc_dev *rcdev; |
| 243 | + int ret; |
| 244 | + |
| 245 | + if (attr->attach_flags) |
| 246 | + return -EINVAL; |
| 247 | + |
| 248 | + prog = bpf_prog_get_type(attr->attach_bpf_fd, |
| 249 | + BPF_PROG_TYPE_LIRC_MODE2); |
| 250 | + if (IS_ERR(prog)) |
| 251 | + return PTR_ERR(prog); |
| 252 | + |
| 253 | + rcdev = rc_dev_get_from_fd(attr->target_fd); |
| 254 | + if (IS_ERR(rcdev)) { |
| 255 | + bpf_prog_put(prog); |
| 256 | + return PTR_ERR(rcdev); |
| 257 | + } |
| 258 | + |
| 259 | + ret = lirc_bpf_detach(rcdev, prog); |
| 260 | + |
| 261 | + bpf_prog_put(prog); |
| 262 | + put_device(&rcdev->dev); |
| 263 | + |
| 264 | + return ret; |
| 265 | +} |
| 266 | + |
| 267 | +int lirc_prog_query(const union bpf_attr *attr, union bpf_attr __user *uattr) |
| 268 | +{ |
| 269 | + __u32 __user *prog_ids = u64_to_user_ptr(attr->query.prog_ids); |
| 270 | + struct bpf_prog_array __rcu *progs; |
| 271 | + struct rc_dev *rcdev; |
| 272 | + u32 cnt, flags = 0; |
| 273 | + int ret; |
| 274 | + |
| 275 | + if (attr->query.query_flags) |
| 276 | + return -EINVAL; |
| 277 | + |
| 278 | + rcdev = rc_dev_get_from_fd(attr->query.target_fd); |
| 279 | + if (IS_ERR(rcdev)) |
| 280 | + return PTR_ERR(rcdev); |
| 281 | + |
| 282 | + if (rcdev->driver_type != RC_DRIVER_IR_RAW) { |
| 283 | + ret = -EINVAL; |
| 284 | + goto put; |
| 285 | + } |
| 286 | + |
| 287 | + ret = mutex_lock_interruptible(&ir_raw_handler_lock); |
| 288 | + if (ret) |
| 289 | + goto put; |
| 290 | + |
| 291 | + progs = rcdev->raw->progs; |
| 292 | + cnt = progs ? bpf_prog_array_length(progs) : 0; |
| 293 | + |
| 294 | + if (copy_to_user(&uattr->query.prog_cnt, &cnt, sizeof(cnt))) { |
| 295 | + ret = -EFAULT; |
| 296 | + goto unlock; |
| 297 | + } |
| 298 | + |
| 299 | + if (copy_to_user(&uattr->query.attach_flags, &flags, sizeof(flags))) { |
| 300 | + ret = -EFAULT; |
| 301 | + goto unlock; |
| 302 | + } |
| 303 | + |
| 304 | + if (attr->query.prog_cnt != 0 && prog_ids && cnt) |
| 305 | + ret = bpf_prog_array_copy_to_user(progs, prog_ids, cnt); |
| 306 | + |
| 307 | +unlock: |
| 308 | + mutex_unlock(&ir_raw_handler_lock); |
| 309 | +put: |
| 310 | + put_device(&rcdev->dev); |
| 311 | + |
| 312 | + return ret; |
| 313 | +} |
0 commit comments