| // INFO: task hung in chaoskey_disconnect |
| // https://syzkaller.appspot.com/bug?id=0bf4a81cd2cf6ff13e659062e6a561137dac7d3a |
| // status:open |
| // autogenerated by syzkaller (https://github.com/google/syzkaller) |
| |
| #define _GNU_SOURCE |
| |
| #include <arpa/inet.h> |
| #include <dirent.h> |
| #include <endian.h> |
| #include <errno.h> |
| #include <fcntl.h> |
| #include <net/if.h> |
| #include <netinet/in.h> |
| #include <signal.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/prctl.h> |
| #include <sys/socket.h> |
| #include <sys/stat.h> |
| #include <sys/syscall.h> |
| #include <sys/types.h> |
| #include <sys/wait.h> |
| #include <time.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); |
| } |
| |
| static uint64_t current_time_ms(void) |
| { |
| struct timespec ts; |
| if (clock_gettime(CLOCK_MONOTONIC, &ts)) |
| exit(1); |
| return (uint64_t)ts.tv_sec * 1000 + (uint64_t)ts.tv_nsec / 1000000; |
| } |
| |
| static bool write_file(const char* file, const char* what, ...) |
| { |
| char buf[1024]; |
| va_list args; |
| va_start(args, what); |
| vsnprintf(buf, sizeof(buf), what, args); |
| va_end(args); |
| buf[sizeof(buf) - 1] = 0; |
| int len = strlen(buf); |
| int fd = open(file, O_WRONLY | O_CLOEXEC); |
| if (fd == -1) |
| return false; |
| if (write(fd, buf, len) != len) { |
| int err = errno; |
| close(fd); |
| errno = err; |
| return false; |
| } |
| close(fd); |
| return true; |
| } |
| |
| 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_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 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; |
| } |
| |
| static void kill_and_wait(int pid, int* status) |
| { |
| kill(-pid, SIGKILL); |
| kill(pid, SIGKILL); |
| int i; |
| for (i = 0; i < 100; i++) { |
| if (waitpid(-1, status, WNOHANG | __WALL) == pid) |
| return; |
| usleep(1000); |
| } |
| DIR* dir = opendir("/sys/fs/fuse/connections"); |
| if (dir) { |
| for (;;) { |
| struct dirent* ent = readdir(dir); |
| if (!ent) |
| break; |
| if (strcmp(ent->d_name, ".") == 0 || strcmp(ent->d_name, "..") == 0) |
| continue; |
| char abort[300]; |
| snprintf(abort, sizeof(abort), "/sys/fs/fuse/connections/%s/abort", |
| ent->d_name); |
| int fd = open(abort, O_WRONLY); |
| if (fd == -1) { |
| continue; |
| } |
| if (write(fd, abort, 1) < 0) { |
| } |
| close(fd); |
| } |
| closedir(dir); |
| } else { |
| } |
| while (waitpid(-1, status, __WALL) != pid) { |
| } |
| } |
| |
| static void setup_test() |
| { |
| prctl(PR_SET_PDEATHSIG, SIGKILL, 0, 0, 0); |
| setpgrp(); |
| write_file("/proc/self/oom_score_adj", "1000"); |
| } |
| |
| static void execute_one(void); |
| |
| #define WAIT_FLAGS __WALL |
| |
| static void loop(void) |
| { |
| int iter; |
| for (iter = 0;; iter++) { |
| int pid = fork(); |
| if (pid < 0) |
| exit(1); |
| if (pid == 0) { |
| setup_test(); |
| execute_one(); |
| exit(0); |
| } |
| int status = 0; |
| uint64_t start = current_time_ms(); |
| for (;;) { |
| if (waitpid(-1, &status, WNOHANG | WAIT_FLAGS) == pid) |
| break; |
| sleep_ms(1); |
| if (current_time_ms() - start < 5 * 1000) |
| continue; |
| kill_and_wait(pid, &status); |
| break; |
| } |
| } |
| } |
| |
| void execute_one(void) |
| { |
| *(uint8_t*)0x20000000 = 0x12; |
| *(uint8_t*)0x20000001 = 1; |
| *(uint16_t*)0x20000002 = 0; |
| *(uint8_t*)0x20000004 = 0x2b; |
| *(uint8_t*)0x20000005 = 0x19; |
| *(uint8_t*)0x20000006 = 0x91; |
| *(uint8_t*)0x20000007 = 0x10; |
| *(uint16_t*)0x20000008 = 0x1d50; |
| *(uint16_t*)0x2000000a = 0x60c6; |
| *(uint16_t*)0x2000000c = 0x1ad7; |
| *(uint8_t*)0x2000000e = 0; |
| *(uint8_t*)0x2000000f = 0; |
| *(uint8_t*)0x20000010 = 0; |
| *(uint8_t*)0x20000011 = 1; |
| *(uint8_t*)0x20000012 = 9; |
| *(uint8_t*)0x20000013 = 2; |
| *(uint16_t*)0x20000014 = 0x1b; |
| *(uint8_t*)0x20000016 = 1; |
| *(uint8_t*)0x20000017 = 0; |
| *(uint8_t*)0x20000018 = 0; |
| *(uint8_t*)0x20000019 = 0; |
| *(uint8_t*)0x2000001a = 0; |
| *(uint8_t*)0x2000001b = 9; |
| *(uint8_t*)0x2000001c = 4; |
| *(uint8_t*)0x2000001d = 0; |
| *(uint8_t*)0x2000001e = 0; |
| *(uint8_t*)0x2000001f = 1; |
| *(uint8_t*)0x20000020 = 0xc9; |
| *(uint8_t*)0x20000021 = 0xb3; |
| *(uint8_t*)0x20000022 = 0xea; |
| *(uint8_t*)0x20000023 = 0; |
| *(uint8_t*)0x20000024 = 9; |
| *(uint8_t*)0x20000025 = 5; |
| *(uint8_t*)0x20000026 = 0x8f; |
| *(uint8_t*)0x20000027 = 2; |
| *(uint16_t*)0x20000028 = 0x49; |
| *(uint8_t*)0x2000002a = 0; |
| *(uint8_t*)0x2000002b = 0; |
| *(uint8_t*)0x2000002c = 0; |
| syz_usb_connect(0, 0x2d, 0x20000000, 0); |
| } |
| int main(void) |
| { |
| syscall(__NR_mmap, 0x20000000ul, 0x1000000ul, 3ul, 0x32ul, -1, 0); |
| for (procid = 0; procid < 6; procid++) { |
| if (fork() == 0) { |
| loop(); |
| } |
| } |
| sleep(1000000); |
| return 0; |
| } |