| // KASAN: slab-out-of-bounds Read in hidinput_hid_event |
| // https://syzkaller.appspot.com/bug?id=dde79cf810cd25364e464f3141523c4444811c4a |
| // status:open |
| // autogenerated by syzkaller (https://github.com/google/syzkaller) |
| |
| #define _GNU_SOURCE |
| |
| #include <arpa/inet.h> |
| #include <endian.h> |
| #include <errno.h> |
| #include <fcntl.h> |
| #include <net/if.h> |
| #include <netinet/in.h> |
| #include <stdarg.h> |
| #include <stdbool.h> |
| #include <stddef.h> |
| #include <stdint.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <sys/mount.h> |
| #include <sys/socket.h> |
| #include <sys/stat.h> |
| #include <sys/syscall.h> |
| #include <sys/types.h> |
| #include <unistd.h> |
| |
| #include <linux/genetlink.h> |
| #include <linux/if_addr.h> |
| #include <linux/if_link.h> |
| #include <linux/in6.h> |
| #include <linux/neighbour.h> |
| #include <linux/net.h> |
| #include <linux/netlink.h> |
| #include <linux/rtnetlink.h> |
| #include <linux/usb/ch9.h> |
| #include <linux/veth.h> |
| |
| unsigned long long procid; |
| |
| static void sleep_ms(uint64_t ms) |
| { |
| usleep(ms * 1000); |
| } |
| |
| struct nlmsg { |
| char* pos; |
| int nesting; |
| struct nlattr* nested[8]; |
| char buf[1024]; |
| }; |
| |
| static struct nlmsg nlmsg; |
| |
| static void netlink_init(struct nlmsg* nlmsg, int typ, int flags, |
| const void* data, int size) |
| { |
| memset(nlmsg, 0, sizeof(*nlmsg)); |
| struct nlmsghdr* hdr = (struct nlmsghdr*)nlmsg->buf; |
| hdr->nlmsg_type = typ; |
| hdr->nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK | flags; |
| memcpy(hdr + 1, data, size); |
| nlmsg->pos = (char*)(hdr + 1) + NLMSG_ALIGN(size); |
| } |
| |
| static void netlink_attr(struct nlmsg* nlmsg, int typ, const void* data, |
| int size) |
| { |
| struct nlattr* attr = (struct nlattr*)nlmsg->pos; |
| attr->nla_len = sizeof(*attr) + size; |
| attr->nla_type = typ; |
| memcpy(attr + 1, data, size); |
| nlmsg->pos += NLMSG_ALIGN(attr->nla_len); |
| } |
| |
| static int netlink_send_ext(struct nlmsg* nlmsg, int sock, uint16_t reply_type, |
| int* reply_len) |
| { |
| if (nlmsg->pos > nlmsg->buf + sizeof(nlmsg->buf) || nlmsg->nesting) |
| exit(1); |
| struct nlmsghdr* hdr = (struct nlmsghdr*)nlmsg->buf; |
| hdr->nlmsg_len = nlmsg->pos - nlmsg->buf; |
| struct sockaddr_nl addr; |
| memset(&addr, 0, sizeof(addr)); |
| addr.nl_family = AF_NETLINK; |
| unsigned n = sendto(sock, nlmsg->buf, hdr->nlmsg_len, 0, |
| (struct sockaddr*)&addr, sizeof(addr)); |
| if (n != hdr->nlmsg_len) |
| exit(1); |
| n = recv(sock, nlmsg->buf, sizeof(nlmsg->buf), 0); |
| if (hdr->nlmsg_type == NLMSG_DONE) { |
| *reply_len = 0; |
| return 0; |
| } |
| if (n < sizeof(struct nlmsghdr)) |
| exit(1); |
| if (reply_len && hdr->nlmsg_type == reply_type) { |
| *reply_len = n; |
| return 0; |
| } |
| if (n < sizeof(struct nlmsghdr) + sizeof(struct nlmsgerr)) |
| exit(1); |
| if (hdr->nlmsg_type != NLMSG_ERROR) |
| exit(1); |
| return -((struct nlmsgerr*)(hdr + 1))->error; |
| } |
| |
| static int netlink_send(struct nlmsg* nlmsg, int sock) |
| { |
| return netlink_send_ext(nlmsg, sock, 0, NULL); |
| } |
| |
| static int netlink_next_msg(struct nlmsg* nlmsg, unsigned int offset, |
| unsigned int total_len) |
| { |
| struct nlmsghdr* hdr = (struct nlmsghdr*)(nlmsg->buf + offset); |
| if (offset == total_len || offset + hdr->nlmsg_len > total_len) |
| return -1; |
| return hdr->nlmsg_len; |
| } |
| |
| static void netlink_device_change(struct nlmsg* nlmsg, int sock, |
| const char* name, bool up, const char* master, |
| const void* mac, int macsize, |
| const char* new_name) |
| { |
| struct ifinfomsg hdr; |
| memset(&hdr, 0, sizeof(hdr)); |
| if (up) |
| hdr.ifi_flags = hdr.ifi_change = IFF_UP; |
| hdr.ifi_index = if_nametoindex(name); |
| netlink_init(nlmsg, RTM_NEWLINK, 0, &hdr, sizeof(hdr)); |
| if (new_name) |
| netlink_attr(nlmsg, IFLA_IFNAME, new_name, strlen(new_name)); |
| if (master) { |
| int ifindex = if_nametoindex(master); |
| netlink_attr(nlmsg, IFLA_MASTER, &ifindex, sizeof(ifindex)); |
| } |
| if (macsize) |
| netlink_attr(nlmsg, IFLA_ADDRESS, mac, macsize); |
| int err = netlink_send(nlmsg, sock); |
| (void)err; |
| } |
| |
| const int kInitNetNsFd = 239; |
| |
| #define DEVLINK_FAMILY_NAME "devlink" |
| |
| #define DEVLINK_CMD_PORT_GET 5 |
| #define DEVLINK_CMD_RELOAD 37 |
| #define DEVLINK_ATTR_BUS_NAME 1 |
| #define DEVLINK_ATTR_DEV_NAME 2 |
| #define DEVLINK_ATTR_NETDEV_NAME 7 |
| #define DEVLINK_ATTR_NETNS_FD 138 |
| |
| static int netlink_devlink_id_get(struct nlmsg* nlmsg, int sock) |
| { |
| struct genlmsghdr genlhdr; |
| struct nlattr* attr; |
| int err, n; |
| uint16_t id = 0; |
| memset(&genlhdr, 0, sizeof(genlhdr)); |
| genlhdr.cmd = CTRL_CMD_GETFAMILY; |
| netlink_init(nlmsg, GENL_ID_CTRL, 0, &genlhdr, sizeof(genlhdr)); |
| netlink_attr(nlmsg, CTRL_ATTR_FAMILY_NAME, DEVLINK_FAMILY_NAME, |
| strlen(DEVLINK_FAMILY_NAME) + 1); |
| err = netlink_send_ext(nlmsg, sock, GENL_ID_CTRL, &n); |
| if (err) { |
| return -1; |
| } |
| attr = (struct nlattr*)(nlmsg->buf + NLMSG_HDRLEN + |
| NLMSG_ALIGN(sizeof(genlhdr))); |
| for (; (char*)attr < nlmsg->buf + n; |
| attr = (struct nlattr*)((char*)attr + NLMSG_ALIGN(attr->nla_len))) { |
| if (attr->nla_type == CTRL_ATTR_FAMILY_ID) { |
| id = *(uint16_t*)(attr + 1); |
| break; |
| } |
| } |
| if (!id) { |
| return -1; |
| } |
| recv(sock, nlmsg->buf, sizeof(nlmsg->buf), 0); /* recv ack */ |
| return id; |
| } |
| |
| static void netlink_devlink_netns_move(const char* bus_name, |
| const char* dev_name, int netns_fd) |
| { |
| struct genlmsghdr genlhdr; |
| int sock; |
| int id, err; |
| sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_GENERIC); |
| if (sock == -1) |
| exit(1); |
| id = netlink_devlink_id_get(&nlmsg, sock); |
| if (id == -1) |
| goto error; |
| memset(&genlhdr, 0, sizeof(genlhdr)); |
| genlhdr.cmd = DEVLINK_CMD_RELOAD; |
| netlink_init(&nlmsg, id, 0, &genlhdr, sizeof(genlhdr)); |
| netlink_attr(&nlmsg, DEVLINK_ATTR_BUS_NAME, bus_name, strlen(bus_name) + 1); |
| netlink_attr(&nlmsg, DEVLINK_ATTR_DEV_NAME, dev_name, strlen(dev_name) + 1); |
| netlink_attr(&nlmsg, DEVLINK_ATTR_NETNS_FD, &netns_fd, sizeof(netns_fd)); |
| err = netlink_send(&nlmsg, sock); |
| if (err) { |
| } |
| error: |
| close(sock); |
| } |
| |
| static struct nlmsg nlmsg2; |
| |
| static void initialize_devlink_ports(const char* bus_name, const char* dev_name, |
| const char* netdev_prefix) |
| { |
| struct genlmsghdr genlhdr; |
| int len, total_len, id, err, offset; |
| uint16_t netdev_index; |
| int sock = socket(AF_NETLINK, SOCK_RAW, NETLINK_GENERIC); |
| if (sock == -1) |
| exit(1); |
| int rtsock = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE); |
| if (rtsock == -1) |
| exit(1); |
| id = netlink_devlink_id_get(&nlmsg, sock); |
| if (id == -1) |
| goto error; |
| memset(&genlhdr, 0, sizeof(genlhdr)); |
| genlhdr.cmd = DEVLINK_CMD_PORT_GET; |
| netlink_init(&nlmsg, id, NLM_F_DUMP, &genlhdr, sizeof(genlhdr)); |
| netlink_attr(&nlmsg, DEVLINK_ATTR_BUS_NAME, bus_name, strlen(bus_name) + 1); |
| netlink_attr(&nlmsg, DEVLINK_ATTR_DEV_NAME, dev_name, strlen(dev_name) + 1); |
| err = netlink_send_ext(&nlmsg, sock, id, &total_len); |
| if (err) { |
| goto error; |
| } |
| offset = 0; |
| netdev_index = 0; |
| while ((len = netlink_next_msg(&nlmsg, offset, total_len)) != -1) { |
| struct nlattr* attr = (struct nlattr*)(nlmsg.buf + offset + NLMSG_HDRLEN + |
| NLMSG_ALIGN(sizeof(genlhdr))); |
| for (; (char*)attr < nlmsg.buf + offset + len; |
| attr = (struct nlattr*)((char*)attr + NLMSG_ALIGN(attr->nla_len))) { |
| if (attr->nla_type == DEVLINK_ATTR_NETDEV_NAME) { |
| char* port_name; |
| char netdev_name[IFNAMSIZ]; |
| port_name = (char*)(attr + 1); |
| snprintf(netdev_name, sizeof(netdev_name), "%s%d", netdev_prefix, |
| netdev_index); |
| netlink_device_change(&nlmsg2, rtsock, port_name, true, 0, 0, 0, |
| netdev_name); |
| break; |
| } |
| } |
| offset += len; |
| netdev_index++; |
| } |
| error: |
| close(rtsock); |
| close(sock); |
| } |
| |
| static void initialize_devlink_pci(void) |
| { |
| int netns = open("/proc/self/ns/net", O_RDONLY); |
| if (netns == -1) |
| exit(1); |
| int ret = setns(kInitNetNsFd, 0); |
| if (ret == -1) |
| exit(1); |
| netlink_devlink_netns_move("pci", "0000:00:10.0", netns); |
| ret = setns(netns, 0); |
| if (ret == -1) |
| exit(1); |
| close(netns); |
| initialize_devlink_ports("pci", "0000:00:10.0", "netpci"); |
| } |
| |
| #define MAX_FDS 30 |
| |
| #define USB_MAX_IFACE_NUM 4 |
| #define USB_MAX_EP_NUM 32 |
| |
| struct usb_iface_index { |
| struct usb_interface_descriptor* iface; |
| uint8_t bInterfaceNumber; |
| uint8_t bAlternateSetting; |
| uint8_t bInterfaceClass; |
| struct usb_endpoint_descriptor eps[USB_MAX_EP_NUM]; |
| int eps_num; |
| }; |
| |
| struct usb_device_index { |
| struct usb_device_descriptor* dev; |
| struct usb_config_descriptor* config; |
| uint8_t bDeviceClass; |
| uint8_t bMaxPower; |
| int config_length; |
| struct usb_iface_index ifaces[USB_MAX_IFACE_NUM]; |
| int ifaces_num; |
| int iface_cur; |
| }; |
| |
| static bool parse_usb_descriptor(char* buffer, size_t length, |
| struct usb_device_index* index) |
| { |
| if (length < sizeof(*index->dev) + sizeof(*index->config)) |
| return false; |
| memset(index, 0, sizeof(*index)); |
| index->dev = (struct usb_device_descriptor*)buffer; |
| index->config = (struct usb_config_descriptor*)(buffer + sizeof(*index->dev)); |
| index->bDeviceClass = index->dev->bDeviceClass; |
| index->bMaxPower = index->config->bMaxPower; |
| index->config_length = length - sizeof(*index->dev); |
| index->iface_cur = -1; |
| size_t offset = 0; |
| while (true) { |
| if (offset + 1 >= length) |
| break; |
| uint8_t desc_length = buffer[offset]; |
| uint8_t desc_type = buffer[offset + 1]; |
| if (desc_length <= 2) |
| break; |
| if (offset + desc_length > length) |
| break; |
| if (desc_type == USB_DT_INTERFACE && |
| index->ifaces_num < USB_MAX_IFACE_NUM) { |
| struct usb_interface_descriptor* iface = |
| (struct usb_interface_descriptor*)(buffer + offset); |
| index->ifaces[index->ifaces_num].iface = iface; |
| index->ifaces[index->ifaces_num].bInterfaceNumber = |
| iface->bInterfaceNumber; |
| index->ifaces[index->ifaces_num].bAlternateSetting = |
| iface->bAlternateSetting; |
| index->ifaces[index->ifaces_num].bInterfaceClass = iface->bInterfaceClass; |
| index->ifaces_num++; |
| } |
| if (desc_type == USB_DT_ENDPOINT && index->ifaces_num > 0) { |
| struct usb_iface_index* iface = &index->ifaces[index->ifaces_num - 1]; |
| if (iface->eps_num < USB_MAX_EP_NUM) { |
| memcpy(&iface->eps[iface->eps_num], buffer + offset, |
| sizeof(iface->eps[iface->eps_num])); |
| iface->eps_num++; |
| } |
| } |
| offset += desc_length; |
| } |
| return true; |
| } |
| |
| #define UDC_NAME_LENGTH_MAX 128 |
| |
| struct usb_raw_init { |
| __u8 driver_name[UDC_NAME_LENGTH_MAX]; |
| __u8 device_name[UDC_NAME_LENGTH_MAX]; |
| __u8 speed; |
| }; |
| |
| enum usb_raw_event_type { |
| USB_RAW_EVENT_INVALID, |
| USB_RAW_EVENT_CONNECT, |
| USB_RAW_EVENT_CONTROL, |
| }; |
| |
| struct usb_raw_event { |
| __u32 type; |
| __u32 length; |
| __u8 data[0]; |
| }; |
| |
| struct usb_raw_ep_io { |
| __u16 ep; |
| __u16 flags; |
| __u32 length; |
| __u8 data[0]; |
| }; |
| |
| #define USB_RAW_IOCTL_INIT _IOW('U', 0, struct usb_raw_init) |
| #define USB_RAW_IOCTL_RUN _IO('U', 1) |
| #define USB_RAW_IOCTL_EVENT_FETCH _IOR('U', 2, struct usb_raw_event) |
| #define USB_RAW_IOCTL_EP0_WRITE _IOW('U', 3, struct usb_raw_ep_io) |
| #define USB_RAW_IOCTL_EP0_READ _IOWR('U', 4, struct usb_raw_ep_io) |
| #define USB_RAW_IOCTL_EP_ENABLE _IOW('U', 5, struct usb_endpoint_descriptor) |
| #define USB_RAW_IOCTL_EP_DISABLE _IOW('U', 6, __u32) |
| #define USB_RAW_IOCTL_EP_WRITE _IOW('U', 7, struct usb_raw_ep_io) |
| #define USB_RAW_IOCTL_EP_READ _IOWR('U', 8, struct usb_raw_ep_io) |
| #define USB_RAW_IOCTL_CONFIGURE _IO('U', 9) |
| #define USB_RAW_IOCTL_VBUS_DRAW _IOW('U', 10, __u32) |
| |
| static int usb_raw_open() |
| { |
| return open("/dev/raw-gadget", O_RDWR); |
| } |
| |
| static int usb_raw_init(int fd, uint32_t speed, const char* driver, |
| const char* device) |
| { |
| struct usb_raw_init arg; |
| strncpy((char*)&arg.driver_name[0], driver, sizeof(arg.driver_name)); |
| strncpy((char*)&arg.device_name[0], device, sizeof(arg.device_name)); |
| arg.speed = speed; |
| return ioctl(fd, USB_RAW_IOCTL_INIT, &arg); |
| } |
| |
| static int usb_raw_run(int fd) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_RUN, 0); |
| } |
| |
| static int usb_raw_event_fetch(int fd, struct usb_raw_event* event) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EVENT_FETCH, event); |
| } |
| |
| static int usb_raw_ep0_write(int fd, struct usb_raw_ep_io* io) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EP0_WRITE, io); |
| } |
| |
| static int usb_raw_ep0_read(int fd, struct usb_raw_ep_io* io) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EP0_READ, io); |
| } |
| |
| static int usb_raw_ep_write(int fd, struct usb_raw_ep_io* io) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EP_WRITE, io); |
| } |
| |
| static int usb_raw_ep_enable(int fd, struct usb_endpoint_descriptor* desc) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EP_ENABLE, desc); |
| } |
| |
| static int usb_raw_ep_disable(int fd, int ep) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_EP_DISABLE, ep); |
| } |
| |
| static int usb_raw_configure(int fd) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_CONFIGURE, 0); |
| } |
| |
| static int usb_raw_vbus_draw(int fd, uint32_t power) |
| { |
| return ioctl(fd, USB_RAW_IOCTL_VBUS_DRAW, power); |
| } |
| |
| #define MAX_USB_FDS 6 |
| |
| struct usb_info { |
| int fd; |
| struct usb_device_index index; |
| }; |
| |
| static struct usb_info usb_devices[MAX_USB_FDS]; |
| static int usb_devices_num; |
| |
| static struct usb_device_index* add_usb_index(int fd, char* dev, size_t dev_len) |
| { |
| int i = __atomic_fetch_add(&usb_devices_num, 1, __ATOMIC_RELAXED); |
| if (i >= MAX_USB_FDS) |
| return NULL; |
| int rv = 0; |
| rv = parse_usb_descriptor(dev, dev_len, &usb_devices[i].index); |
| if (!rv) |
| return NULL; |
| __atomic_store_n(&usb_devices[i].fd, fd, __ATOMIC_RELEASE); |
| return &usb_devices[i].index; |
| } |
| |
| static struct usb_device_index* lookup_usb_index(int fd) |
| { |
| int i; |
| for (i = 0; i < MAX_USB_FDS; i++) { |
| if (__atomic_load_n(&usb_devices[i].fd, __ATOMIC_ACQUIRE) == fd) { |
| return &usb_devices[i].index; |
| } |
| } |
| return NULL; |
| } |
| |
| static int lookup_interface(int fd, uint8_t bInterfaceNumber, |
| uint8_t bAlternateSetting) |
| { |
| struct usb_device_index* index = lookup_usb_index(fd); |
| int i; |
| if (!index) |
| return -1; |
| for (i = 0; i < index->ifaces_num; i++) { |
| if (index->ifaces[i].bInterfaceNumber == bInterfaceNumber && |
| index->ifaces[i].bAlternateSetting == bAlternateSetting) |
| return i; |
| } |
| return -1; |
| } |
| |
| static void set_interface(int fd, int n) |
| { |
| struct usb_device_index* index = lookup_usb_index(fd); |
| int ep; |
| if (!index) |
| return; |
| if (index->iface_cur >= 0 && index->iface_cur < index->ifaces_num) { |
| for (ep = 0; ep < index->ifaces[index->iface_cur].eps_num; ep++) { |
| int rv = usb_raw_ep_disable(fd, ep); |
| if (rv < 0) { |
| } else { |
| } |
| } |
| } |
| if (n >= 0 && n < index->ifaces_num) { |
| for (ep = 0; ep < index->ifaces[n].eps_num; ep++) { |
| int rv = usb_raw_ep_enable(fd, &index->ifaces[n].eps[ep]); |
| if (rv < 0) { |
| } else { |
| } |
| } |
| index->iface_cur = n; |
| } |
| } |
| |
| static int configure_device(int fd) |
| { |
| struct usb_device_index* index = lookup_usb_index(fd); |
| if (!index) |
| return -1; |
| int rv = usb_raw_vbus_draw(fd, index->bMaxPower); |
| if (rv < 0) { |
| return rv; |
| } |
| rv = usb_raw_configure(fd); |
| if (rv < 0) { |
| return rv; |
| } |
| set_interface(fd, 0); |
| return 0; |
| } |
| |
| #define USB_MAX_PACKET_SIZE 1024 |
| |
| struct usb_raw_control_event { |
| struct usb_raw_event inner; |
| struct usb_ctrlrequest ctrl; |
| char data[USB_MAX_PACKET_SIZE]; |
| }; |
| |
| struct usb_raw_ep_io_data { |
| struct usb_raw_ep_io inner; |
| char data[USB_MAX_PACKET_SIZE]; |
| }; |
| |
| struct vusb_connect_string_descriptor { |
| uint32_t len; |
| char* str; |
| } __attribute__((packed)); |
| |
| struct vusb_connect_descriptors { |
| uint32_t qual_len; |
| char* qual; |
| uint32_t bos_len; |
| char* bos; |
| uint32_t strs_len; |
| struct vusb_connect_string_descriptor strs[0]; |
| } __attribute__((packed)); |
| |
| static const char default_string[] = {8, USB_DT_STRING, 's', 0, 'y', 0, 'z', 0}; |
| |
| static const char default_lang_id[] = {4, USB_DT_STRING, 0x09, 0x04}; |
| |
| static bool lookup_connect_response(int fd, |
| struct vusb_connect_descriptors* descs, |
| struct usb_ctrlrequest* ctrl, |
| char** response_data, |
| uint32_t* response_length) |
| { |
| struct usb_device_index* index = lookup_usb_index(fd); |
| uint8_t str_idx; |
| if (!index) |
| return false; |
| switch (ctrl->bRequestType & USB_TYPE_MASK) { |
| case USB_TYPE_STANDARD: |
| switch (ctrl->bRequest) { |
| case USB_REQ_GET_DESCRIPTOR: |
| switch (ctrl->wValue >> 8) { |
| case USB_DT_DEVICE: |
| *response_data = (char*)index->dev; |
| *response_length = sizeof(*index->dev); |
| return true; |
| case USB_DT_CONFIG: |
| *response_data = (char*)index->config; |
| *response_length = index->config_length; |
| return true; |
| case USB_DT_STRING: |
| str_idx = (uint8_t)ctrl->wValue; |
| if (descs && str_idx < descs->strs_len) { |
| *response_data = descs->strs[str_idx].str; |
| *response_length = descs->strs[str_idx].len; |
| return true; |
| } |
| if (str_idx == 0) { |
| *response_data = (char*)&default_lang_id[0]; |
| *response_length = default_lang_id[0]; |
| return true; |
| } |
| *response_data = (char*)&default_string[0]; |
| *response_length = default_string[0]; |
| return true; |
| case USB_DT_BOS: |
| *response_data = descs->bos; |
| *response_length = descs->bos_len; |
| return true; |
| case USB_DT_DEVICE_QUALIFIER: |
| if (!descs->qual) { |
| struct usb_qualifier_descriptor* qual = |
| (struct usb_qualifier_descriptor*)response_data; |
| qual->bLength = sizeof(*qual); |
| qual->bDescriptorType = USB_DT_DEVICE_QUALIFIER; |
| qual->bcdUSB = index->dev->bcdUSB; |
| qual->bDeviceClass = index->dev->bDeviceClass; |
| qual->bDeviceSubClass = index->dev->bDeviceSubClass; |
| qual->bDeviceProtocol = index->dev->bDeviceProtocol; |
| qual->bMaxPacketSize0 = index->dev->bMaxPacketSize0; |
| qual->bNumConfigurations = index->dev->bNumConfigurations; |
| qual->bRESERVED = 0; |
| *response_length = sizeof(*qual); |
| return true; |
| } |
| *response_data = descs->qual; |
| *response_length = descs->qual_len; |
| return true; |
| default: |
| exit(1); |
| return false; |
| } |
| break; |
| default: |
| exit(1); |
| return false; |
| } |
| break; |
| default: |
| exit(1); |
| return false; |
| } |
| return false; |
| } |
| |
| static volatile long syz_usb_connect(volatile long a0, volatile long a1, |
| volatile long a2, volatile long a3) |
| { |
| uint64_t speed = a0; |
| uint64_t dev_len = a1; |
| char* dev = (char*)a2; |
| struct vusb_connect_descriptors* descs = (struct vusb_connect_descriptors*)a3; |
| if (!dev) { |
| return -1; |
| } |
| int fd = usb_raw_open(); |
| if (fd < 0) { |
| return fd; |
| } |
| if (fd >= MAX_FDS) { |
| close(fd); |
| return -1; |
| } |
| struct usb_device_index* index = add_usb_index(fd, dev, dev_len); |
| if (!index) { |
| return -1; |
| } |
| char device[32]; |
| sprintf(&device[0], "dummy_udc.%llu", procid); |
| int rv = usb_raw_init(fd, speed, "dummy_udc", &device[0]); |
| if (rv < 0) { |
| return rv; |
| } |
| rv = usb_raw_run(fd); |
| if (rv < 0) { |
| return rv; |
| } |
| bool done = false; |
| while (!done) { |
| struct usb_raw_control_event event; |
| event.inner.type = 0; |
| event.inner.length = sizeof(event.ctrl); |
| rv = usb_raw_event_fetch(fd, (struct usb_raw_event*)&event); |
| if (rv < 0) { |
| return rv; |
| } |
| if (event.inner.type != USB_RAW_EVENT_CONTROL) |
| continue; |
| bool response_found = false; |
| char* response_data = NULL; |
| uint32_t response_length = 0; |
| if (event.ctrl.bRequestType & USB_DIR_IN) { |
| response_found = lookup_connect_response( |
| fd, descs, &event.ctrl, &response_data, &response_length); |
| if (!response_found) { |
| return -1; |
| } |
| } else { |
| if ((event.ctrl.bRequestType & USB_TYPE_MASK) != USB_TYPE_STANDARD || |
| event.ctrl.bRequest != USB_REQ_SET_CONFIGURATION) { |
| exit(1); |
| return -1; |
| } |
| done = true; |
| } |
| if (done) { |
| rv = configure_device(fd); |
| if (rv < 0) { |
| return rv; |
| } |
| } |
| struct usb_raw_ep_io_data response; |
| response.inner.ep = 0; |
| response.inner.flags = 0; |
| if (response_length > sizeof(response.data)) |
| response_length = 0; |
| if (event.ctrl.wLength < response_length) |
| response_length = event.ctrl.wLength; |
| response.inner.length = response_length; |
| if (response_data) |
| memcpy(&response.data[0], response_data, response_length); |
| else |
| memset(&response.data[0], 0, response_length); |
| if (event.ctrl.bRequestType & USB_DIR_IN) { |
| rv = usb_raw_ep0_write(fd, (struct usb_raw_ep_io*)&response); |
| } else { |
| rv = usb_raw_ep0_read(fd, (struct usb_raw_ep_io*)&response); |
| } |
| if (rv < 0) { |
| return rv; |
| } |
| } |
| sleep_ms(200); |
| return fd; |
| } |
| |
| struct vusb_descriptor { |
| uint8_t req_type; |
| uint8_t desc_type; |
| uint32_t len; |
| char data[0]; |
| } __attribute__((packed)); |
| |
| struct vusb_descriptors { |
| uint32_t len; |
| struct vusb_descriptor* generic; |
| struct vusb_descriptor* descs[0]; |
| } __attribute__((packed)); |
| |
| struct vusb_response { |
| uint8_t type; |
| uint8_t req; |
| uint32_t len; |
| char data[0]; |
| } __attribute__((packed)); |
| |
| struct vusb_responses { |
| uint32_t len; |
| struct vusb_response* generic; |
| struct vusb_response* resps[0]; |
| } __attribute__((packed)); |
| |
| static bool lookup_control_response(struct vusb_descriptors* descs, |
| struct vusb_responses* resps, |
| struct usb_ctrlrequest* ctrl, |
| char** response_data, |
| uint32_t* response_length) |
| { |
| int descs_num = 0; |
| int resps_num = 0; |
| if (descs) |
| descs_num = (descs->len - offsetof(struct vusb_descriptors, descs)) / |
| sizeof(descs->descs[0]); |
| if (resps) |
| resps_num = (resps->len - offsetof(struct vusb_responses, resps)) / |
| sizeof(resps->resps[0]); |
| uint8_t req = ctrl->bRequest; |
| uint8_t req_type = ctrl->bRequestType & USB_TYPE_MASK; |
| uint8_t desc_type = ctrl->wValue >> 8; |
| if (req == USB_REQ_GET_DESCRIPTOR) { |
| int i; |
| for (i = 0; i < descs_num; i++) { |
| struct vusb_descriptor* desc = descs->descs[i]; |
| if (!desc) |
| continue; |
| if (desc->req_type == req_type && desc->desc_type == desc_type) { |
| *response_length = desc->len; |
| if (*response_length != 0) |
| *response_data = &desc->data[0]; |
| else |
| *response_data = NULL; |
| return true; |
| } |
| } |
| if (descs && descs->generic) { |
| *response_data = &descs->generic->data[0]; |
| *response_length = descs->generic->len; |
| return true; |
| } |
| } else { |
| int i; |
| for (i = 0; i < resps_num; i++) { |
| struct vusb_response* resp = resps->resps[i]; |
| if (!resp) |
| continue; |
| if (resp->type == req_type && resp->req == req) { |
| *response_length = resp->len; |
| if (*response_length != 0) |
| *response_data = &resp->data[0]; |
| else |
| *response_data = NULL; |
| return true; |
| } |
| } |
| if (resps && resps->generic) { |
| *response_data = &resps->generic->data[0]; |
| *response_length = resps->generic->len; |
| return true; |
| } |
| } |
| return false; |
| } |
| |
| static volatile long syz_usb_control_io(volatile long a0, volatile long a1, |
| volatile long a2) |
| { |
| int fd = a0; |
| struct vusb_descriptors* descs = (struct vusb_descriptors*)a1; |
| struct vusb_responses* resps = (struct vusb_responses*)a2; |
| struct usb_raw_control_event event; |
| event.inner.type = 0; |
| event.inner.length = USB_MAX_PACKET_SIZE; |
| int rv = usb_raw_event_fetch(fd, (struct usb_raw_event*)&event); |
| if (rv < 0) { |
| return rv; |
| } |
| if (event.inner.type != USB_RAW_EVENT_CONTROL) { |
| return -1; |
| } |
| bool response_found = false; |
| char* response_data = NULL; |
| uint32_t response_length = 0; |
| if ((event.ctrl.bRequestType & USB_DIR_IN) && event.ctrl.wLength) { |
| response_found = lookup_control_response(descs, resps, &event.ctrl, |
| &response_data, &response_length); |
| if (!response_found) { |
| return -1; |
| } |
| } else { |
| if ((event.ctrl.bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD || |
| event.ctrl.bRequest == USB_REQ_SET_INTERFACE) { |
| int iface_num = event.ctrl.wIndex; |
| int alt_set = event.ctrl.wValue; |
| int iface_index = lookup_interface(fd, iface_num, alt_set); |
| if (iface_index < 0) { |
| } else { |
| set_interface(fd, iface_index); |
| } |
| } |
| response_length = event.ctrl.wLength; |
| } |
| struct usb_raw_ep_io_data response; |
| response.inner.ep = 0; |
| response.inner.flags = 0; |
| if (response_length > sizeof(response.data)) |
| response_length = 0; |
| if (event.ctrl.wLength < response_length) |
| response_length = event.ctrl.wLength; |
| if ((event.ctrl.bRequestType & USB_DIR_IN) && !event.ctrl.wLength) { |
| response_length = USB_MAX_PACKET_SIZE; |
| } |
| response.inner.length = response_length; |
| if (response_data) |
| memcpy(&response.data[0], response_data, response_length); |
| else |
| memset(&response.data[0], 0, response_length); |
| if ((event.ctrl.bRequestType & USB_DIR_IN) && event.ctrl.wLength) { |
| rv = usb_raw_ep0_write(fd, (struct usb_raw_ep_io*)&response); |
| } else { |
| rv = usb_raw_ep0_read(fd, (struct usb_raw_ep_io*)&response); |
| } |
| if (rv < 0) { |
| return rv; |
| } |
| sleep_ms(200); |
| return 0; |
| } |
| |
| static volatile long syz_usb_ep_write(volatile long a0, volatile long a1, |
| volatile long a2, volatile long a3) |
| { |
| int fd = a0; |
| uint16_t ep = a1; |
| uint32_t len = a2; |
| char* data = (char*)a3; |
| struct usb_raw_ep_io_data io_data; |
| io_data.inner.ep = ep; |
| io_data.inner.flags = 0; |
| if (len > sizeof(io_data.data)) |
| len = sizeof(io_data.data); |
| io_data.inner.length = len; |
| memcpy(&io_data.data[0], data, len); |
| int rv = usb_raw_ep_write(fd, (struct usb_raw_ep_io*)&io_data); |
| if (rv < 0) { |
| return rv; |
| } |
| sleep_ms(200); |
| return 0; |
| } |
| |
| uint64_t r[1] = {0xffffffffffffffff}; |
| |
| int main(void) |
| { |
| syscall(__NR_mmap, 0x20000000ul, 0x1000000ul, 3ul, 0x32ul, -1, 0); |
| intptr_t res = 0; |
| memcpy((void*)0x20000200, |
| "\x12\x01\x00\x00\x00\x00\x18\x10\x5e\x04\xda\x07\x00\x00\x00\x00\x00" |
| "\x01\x09\x02\x24\x00\x01\x00\x00\x00\x00\x09\x04\x00\x00\x09\x03\x00" |
| "\x00\x00\x09\x21\x00\x00\x00\x01\x22\x22\x00\x09\x05\x81\x03\x08\x00" |
| "\x00\x00\x00\x55\x36\x55\x61\x5a\xa6\x60\xb7\x92\x2b\x7d\x96\x53\x2e" |
| "\xc7\x35\xeb\x27\x5a\x94\xc8\x4e\xc9\x0b\x53\xd1\x44\xe5\x1a\x38\x96" |
| "\xb2\x5b\x05\x42\x22\xec\x64\xb0\x31\x32\x1f\x46\xde\xb2\x4e\x3c\x6a" |
| "\x70\x2e\xef\x8f\x9c\x99\x81\x28\x15\x78\xe1\x90\xfc\x23\x29\x75\xce" |
| "\x1e\xb8\x1c\xcc\x96\xc2\x0a\x00\x00\x00\x00\x00\x00\xbc\xda\x37\xd0" |
| "\xab\xd2\xa0\x69\xfa\x53\x13\x36\x38\x2b\x74\xf0\xe6\xa8\x1a\x15\x6a" |
| "\x6d\x27\x30\xd1\xf9\xdd\x31\xbd\x1e\xe6\xbb\x4d\xb0\xc3\x8c\xb9\xd2" |
| "\x9f\xf7\x56\x48\xc4\x57\xe8\x69\xf7\xe1\x53\x58\x43\x25\xfe\xe3\x69" |
| "\x87\xd0\x42\xfe\xbc\x10\xe2\xcc\xdd\xf3\xd3\xe1\xff\x5c\x8a\xa4\xef" |
| "\x9c\x75\x8c", |
| 207); |
| res = syz_usb_connect(0, 0x36, 0x20000200, 0); |
| if (res != -1) |
| r[0] = res; |
| syz_usb_control_io(r[0], 0, 0); |
| *(uint32_t*)0x200001c0 = 0x24; |
| *(uint64_t*)0x200001c4 = 0; |
| *(uint64_t*)0x200001cc = 0; |
| *(uint64_t*)0x200001d4 = 0x20000000; |
| memcpy((void*)0x20000000, "\x00\x22\x22\x00\x00\x00\x96\x23\x13\x0a\xe5\x3f" |
| "\x07\x0c\x00\x00\x00\x2a\x90\x15\x07\x09\x00\xbe" |
| "\x00\x83\xfe", |
| 27); |
| *(uint64_t*)0x200001dc = 0; |
| syz_usb_control_io(r[0], 0x200001c0, 0); |
| memcpy((void*)0x20000000, "B", 1); |
| syz_usb_ep_write(r[0], 0, 1, 0x20000000); |
| return 0; |
| } |