1 // SPDX-License-Identifier: GPL-2.0 2 // bpf-lirc.c - handles bpf 3 // 4 // Copyright (C) 2018 Sean Young <sean@mess.org> 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 } 314