Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 9d506fc6 authored by Tony Lindgren's avatar Tony Lindgren Committed by Felipe Balbi
Browse files

usb: musb: Populate new IO functions for tusb6010



Let's populate the new IO functions for tusb6010 but not use
them yet.

Signed-off-by: default avatarTony Lindgren <tony@atomide.com>
Signed-off-by: default avatarFelipe Balbi <balbi@ti.com>
parent 5450ac88
Loading
Loading
Loading
Loading
+41 −0
Original line number Original line Diff line number Diff line
@@ -126,6 +126,41 @@ static void tusb_wbus_quirk(struct musb *musb, int enabled)
	}
	}
}
}


static u32 tusb_fifo_offset(u8 epnum)
{
	return 0x200 + (epnum * 0x20);
}

/*
 * TUSB6010 doesn't allow 8-bit access; 16-bit access is the minimum.
 */
static u8 tusb_readb(const void __iomem *addr, unsigned offset)
{
	u16 tmp;
	u8 val;

	tmp = __raw_readw(addr + (offset & ~1));
	if (offset & 1)
		val = (tmp >> 8);
	else
		val = tmp & 0xff;

	return val;
}

static void tusb_writeb(void __iomem *addr, unsigned offset, u8 data)
{
	u16 tmp;

	tmp = __raw_readw(addr + (offset & ~1));
	if (offset & 1)
		tmp = (data << 8) | (tmp & 0xff);
	else
		tmp = (tmp & 0xff00) | data;

	__raw_writew(tmp, addr + (offset & ~1));
}

/*
/*
 * TUSB 6010 may use a parallel bus that doesn't support byte ops;
 * TUSB 6010 may use a parallel bus that doesn't support byte ops;
 * so both loading and unloading FIFOs need explicit byte counts.
 * so both loading and unloading FIFOs need explicit byte counts.
@@ -1135,9 +1170,15 @@ static int tusb_musb_exit(struct musb *musb)
}
}


static const struct musb_platform_ops tusb_ops = {
static const struct musb_platform_ops tusb_ops = {
	.quirks		= MUSB_IN_TUSB,
	.init		= tusb_musb_init,
	.init		= tusb_musb_init,
	.exit		= tusb_musb_exit,
	.exit		= tusb_musb_exit,


	.fifo_offset	= tusb_fifo_offset,
	.readb		= tusb_readb,
	.writeb		= tusb_writeb,
	.read_fifo	= musb_read_fifo,
	.write_fifo	= musb_write_fifo,
	.enable		= tusb_musb_enable,
	.enable		= tusb_musb_enable,
	.disable	= tusb_musb_disable,
	.disable	= tusb_musb_disable,