Training courses

Kernel and Embedded Linux

Bootlin training courses

Embedded Linux, kernel,
Yocto Project, Buildroot, real-time,
graphics, boot time, debugging...

Bootlin logo

Elixir Cross Referencer

/*	$NetBSD: wzero3_usb.c,v 1.2 2011/07/19 15:37:39 dyoung Exp $	*/

/*
 * Copyright (c) 2009 NONAKA Kimihiro <nonaka@netbsd.org>
 * All rights reserved.
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: wzero3_usb.c,v 1.2 2011/07/19 15:37:39 dyoung Exp $");

#include <sys/param.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/bus.h>

#include <arm/xscale/pxa2x0reg.h>
#include <arm/xscale/pxa2x0var.h>
#include <arm/xscale/pxa2x0_gpio.h>

#include <machine/bootinfo.h>
#include <machine/config_hook.h>
#include <machine/platid.h>
#include <machine/platid_mask.h>

#include <hpcarm/dev/wzero3_reg.h>

#if defined(WZERO3USB_DEBUG)
#define	DPRINTF(s)	printf s
#else
#define	DPRINTF(s)
#endif

struct wzero3usb_softc {
	device_t sc_dev;

	bus_space_tag_t sc_iot;
	bus_space_handle_t sc_ioh;

	int sc_client_pin;
	int sc_host_pin;
	int sc_host_power_pin;

	void *sc_client_ih;
	void *sc_host_ih;
};

static int wzero3usb_match(device_t, cfdata_t, void *);
static void wzero3usb_attach(device_t, device_t, void *);

CFATTACH_DECL_NEW(wzero3usb, sizeof(struct wzero3usb_softc), 
    wzero3usb_match, wzero3usb_attach, NULL, NULL);

static int wzero3usb_client_intr(void *);
static int wzero3usb_host_intr(void *);
static void wzero3usb_host_power(struct wzero3usb_softc *);

static const struct wzero3usb_model {
	platid_mask_t *platid;
	int client_pin;
	int host_pin;
	int host_power_pin;
} wzero3usb_table[] = {
	/* WS003SH */
	{
		&platid_mask_MACH_SHARP_WZERO3_WS003SH,
		GPIO_WS003SH_USB_CLIENT_DETECT,
		-1,	/* None */
		-1,	/* None */
	},
	/* WS004SH */
	{
		&platid_mask_MACH_SHARP_WZERO3_WS004SH,
		GPIO_WS003SH_USB_CLIENT_DETECT,
		-1,	/* None */
		-1,	/* None */
	},
	/* WS007SH */
	{
		&platid_mask_MACH_SHARP_WZERO3_WS007SH,
		GPIO_WS007SH_USB_CLIENT_DETECT,
		GPIO_WS007SH_USB_HOST_DETECT,
		GPIO_WS007SH_USB_HOST_POWER,
	},
	/* WS011SH */
	{
		&platid_mask_MACH_SHARP_WZERO3_WS011SH,
		GPIO_WS011SH_USB_CLIENT_DETECT,
		GPIO_WS011SH_USB_HOST_DETECT,
		GPIO_WS011SH_USB_HOST_POWER,
	},
	/* XXX: WS020SH */

	{ NULL, -1, -1, -1, }
};

static const struct wzero3usb_model *
wzero3usb_lookup(void)
{
	const struct wzero3usb_model *model;

	for (model = wzero3usb_table; model->platid != NULL; model++) {
		if (platid_match(&platid, model->platid)) {
			return model;
		}
	}
	return NULL;
}

static int
wzero3usb_match(device_t parent, cfdata_t cf, void *aux)
{

	if (strcmp(cf->cf_name, "wzero3usb") != 0)
		return 0;
	if (wzero3usb_lookup() == NULL)
		return 0;
	return 1;
}

static void
wzero3usb_attach(device_t parent, device_t self, void *aux)
{
	struct wzero3usb_softc *sc = device_private(self);
	struct pxaip_attach_args *pxa = aux;
	const struct wzero3usb_model *model;

	sc->sc_dev = self;
	sc->sc_iot = pxa->pxa_iot;

	aprint_normal(": USB Mode detection\n");

	model = wzero3usb_lookup();
	if (model == NULL) {
		aprint_error_dev(self, "unknown model\n");
		return;
	}
	sc->sc_client_pin = model->client_pin;
	sc->sc_host_pin = model->host_pin;
	sc->sc_host_power_pin = model->host_power_pin;

	if (bus_space_map(sc->sc_iot, PXA2X0_USBDC_BASE, PXA270_USBDC_SIZE, 0,
				&sc->sc_ioh)) {
		aprint_error_dev(self, "couldn't map memory space\n");
		return;
	}

	if (sc->sc_client_pin >= 0) {
		sc->sc_client_ih = pxa2x0_gpio_intr_establish(sc->sc_client_pin,
		    IST_EDGE_BOTH, IPL_BIO, wzero3usb_client_intr, sc);
	}
	if (sc->sc_host_pin >= 0) {
		sc->sc_host_ih = pxa2x0_gpio_intr_establish(sc->sc_host_pin,
		    IST_EDGE_BOTH, IPL_BIO, wzero3usb_host_intr, sc);
	}

	/* configure port 2 for input */
	bus_space_write_4(sc->sc_iot, sc->sc_ioh, USBDC_UP2OCR,
			USBDC_UP2OCR_HXS | USBDC_UP2OCR_HXOE | 
			USBDC_UP2OCR_DPPDE | USBDC_UP2OCR_DMPDE);

	wzero3usb_host_power(sc);
}

static int
wzero3usb_host_intr(void *v)
{
	struct wzero3usb_softc *sc = (struct wzero3usb_softc *)v;

	DPRINTF(("%s: USB host cable changed: level = %s\n",
	    device_xname(sc->sc_dev),
	    pxa2x0_gpio_get_bit(sc->sc_host_pin) ? "H" : "L"));

	wzero3usb_host_power(sc);

	return 1;
}

static int
wzero3usb_client_intr(void *v)
{
	struct wzero3usb_softc *sc = (struct wzero3usb_softc *)v;

	DPRINTF(("%s: USB client cable changed: level = %s\n",
	    device_xname(sc->sc_dev),
	    pxa2x0_gpio_get_bit(sc->sc_client_pin) ? "H" : "L"));

	(void)sc; /*XXX*/

	return 1;
}

static void
wzero3usb_host_power(struct wzero3usb_softc *sc)
{
	int host_cable;

	if (sc->sc_host_pin >= 0 && sc->sc_host_power_pin >= 0) {
		host_cable = pxa2x0_gpio_get_bit(sc->sc_host_pin);

		if (!host_cable) {
			DPRINTF(("%s: enable USB host power\n",
			    device_xname(sc->sc_dev)));
			pxa2x0_gpio_set_bit(sc->sc_host_power_pin);
		} else {
			DPRINTF(("%s: disable USB host power\n",
			    device_xname(sc->sc_dev)));
			pxa2x0_gpio_clear_bit(sc->sc_host_power_pin);
		}
	}
}