| // BUG: bad host security descriptor; not enough data (3 vs 5 left) |
| // https://syzkaller.appspot.com/bug?id=4a4b122eac9f4a5b6181ae2c58b94a7374f8b3f0 |
| // status:dup |
| // 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_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; |
| } |
| |
| int main(void) |
| { |
| syscall(__NR_mmap, 0x20000000ul, 0x1000000ul, 3ul, 0x32ul, -1, 0); |
| |
| memcpy( |
| (void*)0x20000280, |
| "\x12\x01\x00\x00\x52\x63\x8f\x40\xdc\x13\x11\x56\x15\x2f\x00\x00\x00\x01" |
| "\x09\x02\x44\x00\x01\x00\x00\x00\x00\x09\x04\x00\x00\x04\xe0\x02\x01\x00" |
| "\x09\x05\x84\x03\x3e\x33\x00\x00\x00\x09\x05\x0f\x00\x00\x00\x00\x00\x00" |
| "\x09\x05\x07\x00\x00\x00\x00\x00\x00\x09\x0c\x08\x00\x00\x1f\x00\x00\x00" |
| "\x0e\x21\x34\x6a\xc2\x92\x0d\xbf\x07\x7d\x35\x4a\x2f\x72\x55\xba\x12\xa8" |
| "\x4c\x1f\xe1\xde\x68\x52\x3b\x47\xdc\xeb\x5c\x1d\xdb\x44\x75\x2f\x01\xb9" |
| "\xeb\xd7\x9a\xa9\x10\x98\x9a\xe3\xa8\x80\x46\x9d\x88\x91\x92\x69\xcd\xb2" |
| "\x57\xe1\x91\x40\xb3\xfa\x41\x1c\xc5\xed\x4c\xe7\xd3\x2e\x8f\x8c\xdf\x86" |
| "\x73\x9e\x27\xab\x43\x8f\xe9\xec\xeb\x38\x9b\x6f\x73\xf2\x20\xc3\xc5\xb0" |
| "\x76\x63\x41\xd8\x0e\x64\xa5\xf1\x63\x95\xf5\xc1\x18\xd7\x1d\x09\x84\xbb" |
| "\x42\xc3\x85\xf5\x6b\xe5\x27\x96\x32\xed\x9a\xf2\x12\x96\x11\x36\x74\xdf" |
| "\xe0\x03\xcf\xff\xbb\x81\x1c\xd2\xfc\xe8\x52\xe0\x99\xdf\x83\x6f\x52\xd4" |
| "\xee\xf4\x5a\xb9\xdc\xfe\x7e\x4e\x8c\x34\x1d\x38\x32\x42\x89\x00\xa4\x0a" |
| "\xe1\x39\xe2\xf8\x7b\xc8\x76\x47\x06\x08\x42\x5d\x34\x76\xf4\xd3\xcb\xd8" |
| "\x4b\x57\xcb\xb3\x3a\xcb\xda\x85\x42\xf2\x0a\x08\xca\xec\xee\xd1\xec\xad" |
| "\x91\xf7\x8b\x59\xcd\x24\xba\xe6\xc4\x48\x82\x8b\xd0\x6a\x0e\x91\x41\x6a" |
| "\xf2\xaa\x6c\x0b\xd2\xc5\xe9\xe0\x80\xc1\x24\x4f\xda\x7a\x19\xa1\x67\x35" |
| "\xc0\xff\x5e\x48\xce\x3f\x4e\xfc\xdf\xbf\xed\xc3\x58\x55\xfc\x95\x0d\xaa" |
| "\x66\x19\xa3\xe8\x59\x4e\xd2\x91\xda\x38\xd0\xbe\xa9\x17\x9a\x3d\xc0\x26" |
| "\xcd\x93\x6d\x5a\x2b\xe7\x38\x51\x17\x0b\xf2\xaf\xff\x8b\xe4\x65\x7e\xf1" |
| "\x29\x82\xbe\xad\xec\x3c\xfc\xbe\xd1\x4f\xef\x1d\xa6\x86\x7c\x7d\xc3\x83" |
| "\x9d\xb5\x6b\x4a\xcc\x4e\x07\x3e\x11\x07\x02\x48\x51\x76\x3c\xf2\xfc\x76" |
| "\x5f\x5d\xd0\xf9\xe6\xdf\x3f\x7d\xfb\x0d\xe1\x65\x81\x4f\x4f\x67\x65\x22" |
| "\x2a\x91\x11\x0a\x81\x9f\xce\x30\xa4\x9c\x9d\xd1\x84\x58\x95\x4a\xcf\xad" |
| "\x77\x8d\xe8\x64\x1a\x37\x48\xb8\x83\xd0\x04\x67\xb5\x01\xe6\x65\x1b\x75" |
| "\xdf\x67\x86\xcd\x6a\x77\xcd\x5a\xab\x9c\x4a\xa7\xe8\xba\x5a\x30\xf8\x4c" |
| "\xac\x05\x1e\x86\x6c\xab\x2e\xe4\xd5\x93\x21\xbe\x36\x0c\x7d\x5e\x50\x89" |
| "\x9a\xda\x21\xfb\x27\xfb\xbc\xcf\x41\x7d\x61\xdf\xe8\xf8\xb7\x39\xac\x86" |
| "\xf8\x48\x86\x8f\xe8\x09\x60\xcc\x20\x6a\x3e\xf6\xd3\xee\x15\xb3\xc5\x5c" |
| "\xab\x37\x7a\xa7\x8a\xf2\x5a\xaf\xd8\x16\xc1\x95\xe9\xfa\x2d\xc3\x6d\x83" |
| "\x63\x55\xf2\x70\xae\x1f\x35\xe0\x20\x4c\xe0\x89\x0e\x3b\xe9\xb7\xee\x2f" |
| "\x97\xfc\x91\x3c\x18\x08\xe4\xcd\x10\x79\xaa\x53\xb1\xd4\xbe\x0e\xec\xd5" |
| "\x33\xc8\x39\x7b\xb7\x91\x19\x31\x3d\xfc\xe8\x82\x23\x1f\x8b\xcc\x50\x4a" |
| "\x99\x99\x7e", |
| 597); |
| syz_usb_connect(0, 0x56, 0x20000280, 0); |
| return 0; |
| } |