Skip to content
Snippets Groups Projects
usb-sandbox.c 2.62 KiB
Newer Older
  • Learn to ignore specific revisions
  • /*
     * (C) Copyright 2015 Google, Inc
     * Written by Simon Glass <sjg@chromium.org>
     *
     * SPDX-License-Identifier:	GPL-2.0+
     */
    
    #include <common.h>
    #include <dm.h>
    #include <usb.h>
    #include <dm/root.h>
    
    DECLARE_GLOBAL_DATA_PTR;
    
    static void usbmon_trace(struct udevice *bus, ulong pipe,
    			 struct devrequest *setup, struct udevice *emul)
    {
    	static const char types[] = "ZICB";
    	int type;
    
    	type = (pipe & USB_PIPE_TYPE_MASK) >> USB_PIPE_TYPE_SHIFT;
    	debug("0 0 S %c%c:%d:%03ld:%ld", types[type],
    	      pipe & USB_DIR_IN ? 'i' : 'o',
    	      bus->seq,
    	      (pipe & USB_PIPE_DEV_MASK) >> USB_PIPE_DEV_SHIFT,
    	      (pipe & USB_PIPE_EP_MASK) >> USB_PIPE_EP_SHIFT);
    	if (setup) {
    		debug(" s %02x %02x %04x %04x %04x", setup->requesttype,
    		      setup->request, setup->value, setup->index,
    		      setup->length);
    	}
    	debug(" %s", emul ? emul->name : "(no emul found)");
    
    	debug("\n");
    }
    
    static int sandbox_submit_control(struct udevice *bus,
    				      struct usb_device *udev,
    				      unsigned long pipe,
    				      void *buffer, int length,
    				      struct devrequest *setup)
    {
    	struct udevice *emul;
    	int ret;
    
    	/* Just use child of dev as emulator? */
    	debug("%s: bus=%s\n", __func__, bus->name);
    	ret = usb_emul_find(bus, pipe, &emul);
    	usbmon_trace(bus, pipe, setup, emul);
    	if (ret)
    		return ret;
    	ret = usb_emul_control(emul, udev, pipe, buffer, length, setup);
    	if (ret < 0) {
    		debug("ret=%d\n", ret);
    		udev->status = ret;
    		udev->act_len = 0;
    	} else {
    		udev->status = 0;
    		udev->act_len = ret;
    	}
    
    	return ret;
    }
    
    static int sandbox_submit_bulk(struct udevice *bus, struct usb_device *udev,
    			       unsigned long pipe, void *buffer, int length)
    {
    	struct udevice *emul;
    	int ret;
    
    	/* Just use child of dev as emulator? */
    	debug("%s: bus=%s\n", __func__, bus->name);
    	ret = usb_emul_find(bus, pipe, &emul);
    	usbmon_trace(bus, pipe, NULL, emul);
    	if (ret)
    		return ret;
    	ret = usb_emul_bulk(emul, udev, pipe, buffer, length);
    	if (ret < 0) {
    		debug("ret=%d\n", ret);
    		udev->status = ret;
    		udev->act_len = 0;
    	} else {
    		udev->status = 0;
    		udev->act_len = ret;
    	}
    
    	return ret;
    }
    
    static int sandbox_alloc_device(struct udevice *dev, struct usb_device *udev)
    {
    	return 0;
    }
    
    static int sandbox_usb_probe(struct udevice *dev)
    {
    	return 0;
    }
    
    static const struct dm_usb_ops sandbox_usb_ops = {
    	.control	= sandbox_submit_control,
    	.bulk		= sandbox_submit_bulk,
    	.alloc_device	= sandbox_alloc_device,
    };
    
    static const struct udevice_id sandbox_usb_ids[] = {
    	{ .compatible = "sandbox,usb" },
    	{ }
    };
    
    U_BOOT_DRIVER(usb_sandbox) = {
    	.name	= "usb_sandbox",
    	.id	= UCLASS_USB,
    	.of_match = sandbox_usb_ids,
    	.probe = sandbox_usb_probe,
    	.ops	= &sandbox_usb_ops,
    };