Subversion Repositories freemyipod

#include "global.h"

#include "core/synopsysotg/synopsysotg.h"

#include "protocol/usb/usb.h"

#include "sys/time.h"

#include "sys/util.h"

#ifndef SYNOPSYSOTG_AHB_BURST_LEN

#define SYNOPSYSOTG_AHB_BURST_LEN 5

#endif

#ifndef SYNOPSYSOTG_AHB_THRESHOLD

#define SYNOPSYSOTG_AHB_THRESHOLD 8

#endif

#ifndef SYNOPSYSOTG_TURNAROUND

#define SYNOPSYSOTG_TURNAROUND 3

#endif

static void synopsysotg_flush_out_endpoint(const struct usb_instance* instance, int ep)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    if (data->core->outep_regs[ep].doepctl.b.epena)

    {

        // We are waiting for an OUT packet on this endpoint, which might arrive any moment.

        // Assert a global output NAK to avoid race conditions while shutting down the endpoint.

        synopsysotg_target_disable_irq(instance);

        data->core->dregs.dctl.b.sgoutnak = 1;

        while (!(data->core->gregs.gintsts.b.goutnakeff));

        union synopsysotg_depctl doepctl = { .b = { .snak = 1, .epdis = 1 } };

        data->core->outep_regs[ep].doepctl = doepctl;

        while (!(data->core->outep_regs[ep].doepint.b.epdisabled));

        data->core->dregs.dctl.b.cgoutnak = 1;

        synopsysotg_target_enable_irq(instance);

    }

    data->core->outep_regs[ep].doepctl.b.usbactep = 0;

    // Reset the transfer size register. Not strictly necessary, but can't hurt.

    data->core->outep_regs[ep].doeptsiz.d32 = 0;

}

static void synopsysotg_flush_in_endpoint(const struct usb_instance* instance, int ep)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    if (data->core->inep_regs[ep].diepctl.b.epena)

    {

        // We are shutting down an endpoint that might still have IN packets in the FIFO.

        // Disable the endpoint, wait for things to settle, and flush the relevant FIFO.

        synopsysotg_target_disable_irq(instance);

        data->core->inep_regs[ep].diepctl.b.snak = 1;

        while (!(data->core->inep_regs[ep].diepint.b.inepnakeff));

        data->core->inep_regs[ep].diepctl.b.epdis = 1;

        while (!(data->core->inep_regs[ep].diepint.b.epdisabled));

        if (ep) data->core->inep_regs[ep].diepctl.b.usbactep = 0;

        synopsysotg_target_enable_irq(instance);

        // Wait for any DMA activity to stop, to make sure nobody will touch the FIFO.

        while (!data->core->gregs.grstctl.b.ahbidle);

        // Flush it all the way down!

        union synopsysotg_grstctl grstctl = { .b = { .txfnum = data->core->inep_regs[ep].diepctl.b.txfnum, .txfflsh = 1 } };

        data->core->gregs.grstctl = grstctl;

        while (data->core->gregs.grstctl.b.txfflsh);

    }

    else if (ep) data->core->inep_regs[ep].diepctl.b.usbactep = 0;

    // Reset the transfer size register. Not strictly necessary, but can't hurt.

    data->core->inep_regs[ep].dieptsiz.d32 = 0;

}

static void synopsysotg_flush_ints(const struct usb_instance* instance)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    int i;

    for (i = 0; i < 16; i++)

    {

        data->core->outep_regs[i].doepint = data->core->outep_regs[i].doepint;

        data->core->inep_regs[i].diepint = data->core->inep_regs[i].diepint;

    }

    data->core->gregs.gintsts = data->core->gregs.gintsts;

}

static void synopsysotg_try_push(const struct usb_instance* instance, int ep)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    union synopsysotg_depctl depctl = data->core->inep_regs[ep].diepctl;

    if (!depctl.b.epena || !depctl.b.usbactep || depctl.b.stall || depctl.b.naksts) return;

    int bytesleft = data->core->inep_regs[ep].dieptsiz.b.xfersize;

    if (!bytesleft) return;

    int maxpacket = ep ? data->core->inep_regs[ep].diepctl.b.mps : 64;

    union synopsysotg_hnptxsts fifospace = data->core->gregs.hnptxsts;

    int words = (MIN(maxpacket, bytesleft) + 3) >> 2;

    if (fifospace.b.nptxqspcavail && fifospace.b.nptxfspcavail << 2 >= words)

        while (words--) data->core->dfifo[ep][0] = *state->endpoints[ep].txaddr++;

    if (!words && bytesleft <= maxpacket) return;

    data->core->gregs.gintmsk.b.nptxfempty = true;

}

void synopsysotg_start_rx(const struct usb_instance* instance, union usb_endpoint_number ep, void* buf, int size)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    // Find the appropriate set of endpoint registers

    volatile struct synopsysotg_outepregs* regs = &data->core->outep_regs[ep.number];

    // Calculate number of packets (if size == 0 an empty packet will be sent)

    int maxpacket = regs->doepctl.b.mps;

    int packets = (size + maxpacket - 1) / maxpacket;

    if (!packets) packets = 1;

    // Set up data destination

    if (data->use_dma) regs->doepdma = buf;

    else state->endpoints[ep.number].rxaddr = (uint32_t*)buf;

    union synopsysotg_depxfrsiz deptsiz = { .b = { .pktcnt = packets, .xfersize = size } };

    regs->doeptsiz = deptsiz;

    // Flush CPU cache if necessary

    if (data->use_dma) invalidate_dcache(buf, size);

    // Enable the endpoint

    union synopsysotg_depctl depctl = regs->doepctl;

    depctl.b.epena = 1;

    depctl.b.cnak = 1;

    regs->doepctl = depctl;

}

void synopsysotg_start_tx(const struct usb_instance* instance, union usb_endpoint_number ep, const void* buf, int size)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    // Find the appropriate set of endpoint registers

    volatile struct synopsysotg_inepregs* regs = &data->core->inep_regs[ep.number];

    // Calculate number of packets (if size == 0 an empty packet will be sent)

    int maxpacket = regs->diepctl.b.mps;

    int packets = (size + maxpacket - 1) / maxpacket;

    if (!packets) packets = 1;

    // Set up data source

    if (data->use_dma) regs->diepdma = buf;

    else state->endpoints[ep.number].txaddr = (uint32_t*)buf;

    union synopsysotg_depxfrsiz deptsiz = { .b = { .pktcnt = packets, .xfersize = size } };

    regs->dieptsiz = deptsiz;

    // Flush CPU cache if necessary

    if (data->use_dma) clean_dcache(buf, size);

    // Enable the endpoint

    union synopsysotg_depctl depctl = regs->diepctl;

    depctl.b.epena = 1;

    depctl.b.cnak = 1;

    regs->diepctl = depctl;

    // Start pushing data into the FIFO (must be done after enabling the endpoint)

    if (size && !data->use_dma)

    {

        if (data->shared_txfifo) synopsysotg_try_push(instance, ep.number);

        else data->core->dregs.diepempmsk.ep.in |= (1 << ep.number);

    }

}

int synopsysotg_get_stall(const struct usb_instance* instance, union usb_endpoint_number ep)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    if (ep.direction == USB_ENDPOINT_DIRECTION_IN)

        return !!data->core->inep_regs[ep.number].diepctl.b.stall;

    return !!data->core->outep_regs[ep.number].doepctl.b.stall;

}

void synopsysotg_set_stall(const struct usb_instance* instance, union usb_endpoint_number ep, int stall)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    if (ep.direction == USB_ENDPOINT_DIRECTION_IN)

    {

        data->core->inep_regs[ep.number].diepctl.b.stall = !!stall;

        if (!stall) data->core->inep_regs[ep.number].diepctl.b.setd0pid = true;

    }

    else

    {

        data->core->outep_regs[ep.number].doepctl.b.stall = !!stall;

        if (!stall) data->core->outep_regs[ep.number].doepctl.b.setd0pid = true;

    }

}

void synopsysotg_set_address(const struct usb_instance* instance, uint8_t address)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    data->core->dregs.dcfg.b.devaddr = address;

}

void synopsysotg_unconfigure_ep(const struct usb_instance* instance, union usb_endpoint_number ep)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    if (ep.direction == USB_ENDPOINT_DIRECTION_IN)

    {

        // Kill any outstanding IN transfers

        synopsysotg_flush_in_endpoint(instance, ep.number);

        // Mask interrupts for this endpoint

        data->core->dregs.daintmsk.ep.in &= ~(1 << ep.number);

    }

    else

    {

        // Kill any outstanding OUT transfers

        synopsysotg_flush_out_endpoint(instance, ep.number);

        // Mask interrupts for this endpoint

        data->core->dregs.daintmsk.ep.out &= ~(1 << ep.number);

    }

}

void synopsysotg_configure_ep(const struct usb_instance* instance, union usb_endpoint_number ep,

                              enum usb_endpoint_type type, int maxpacket)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    // Write the new configuration and unmask interrupts for the endpoint.

    // Reset data toggle to DATA0, as required by the USB specification.

    int txfifo = data->shared_txfifo ? 0 : ep.number;

    union synopsysotg_depctl depctl = { .b = { .usbactep = 1, .eptype = type, .mps = maxpacket,

                                               .txfnum = txfifo, .setd0pid = 1, .nextep = (ep.number + 1) & 0xf } };

    if (ep.direction == USB_ENDPOINT_DIRECTION_IN)

    {

        data->core->inep_regs[ep.number].diepctl = depctl;

        data->core->dregs.daintmsk.ep.in |= (1 << ep.number);

    }

    else

    {

        data->core->outep_regs[ep.number].doepctl = depctl;

        data->core->dregs.daintmsk.ep.out |= (1 << ep.number);

    }

}

void synopsysotg_ep0_start_rx(const struct usb_instance* instance, int non_setup)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    // If we don't expect a non-SETUP packet, we can stall the OUT pipe,

    // SETUP packets will ignore that.

    if (!non_setup) data->core->outep_regs[0].doepctl.b.stall = 1;

    // Set up data destination

    if (data->use_dma) data->core->outep_regs[0].doepdma = instance->buffer;

    else state->endpoints[0].rxaddr = (uint32_t*)instance->buffer;

    union synopsysotg_dep0xfrsiz deptsiz = { .b = { .supcnt = 3, .pktcnt = !!non_setup, .xfersize = 64 } };

    data->core->outep_regs[0].doeptsiz.d32 = deptsiz.d32;

    // Flush CPU cache if necessary

    if (data->use_dma) invalidate_dcache(instance->buffer, sizeof(instance->buffer));

    // Enable the endpoint

    union synopsysotg_depctl depctl = data->core->outep_regs[0].doepctl;

    depctl.b.epena = 1;

    depctl.b.cnak = 1;

    data->core->outep_regs[0].doepctl = depctl;

}

void synopsysotg_ep0_start_tx(const struct usb_instance* instance, const void* buf, int len)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    if (len)

    {

        // Set up data source

        if (data->use_dma) data->core->inep_regs[0].diepdma = buf;

        else state->endpoints[0].txaddr = buf;

        union synopsysotg_dep0xfrsiz deptsiz = { .b = { .pktcnt = (len + 63) >> 6, .xfersize = len } };

        data->core->inep_regs[0].dieptsiz.d32 = deptsiz.d32;

    }

    else

    {

        // Set up the IN pipe for a zero-length packet

        union synopsysotg_dep0xfrsiz deptsiz = { .b = { .pktcnt = 1 } };

        data->core->inep_regs[0].dieptsiz.d32 = deptsiz.d32;

    }

    // Flush CPU cache if necessary

    if (data->use_dma) clean_dcache(buf, len);

    // Enable the endpoint

    union synopsysotg_depctl depctl = data->core->inep_regs[0].diepctl;

    depctl.b.epena = 1;

    depctl.b.cnak = 1;

    data->core->inep_regs[0].diepctl = depctl;

    // Start pushing data into the FIFO (must be done after enabling the endpoint)

    if (len && !data->use_dma)

    {

        if (data->shared_txfifo) synopsysotg_try_push(instance, 0);

        else data->core->dregs.diepempmsk.ep.in |= 1;

    }

}

static void synopsysotg_ep0_init(const struct usb_instance* instance)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    // Make sure both EP0 pipes are active.

    // (The hardware should take care of that, but who knows...)

    union synopsysotg_depctl depctl = { .b = { .usbactep = 1, .nextep = data->core->inep_regs[0].diepctl.b.nextep } };

    data->core->outep_regs[0].doepctl = depctl;

    data->core->inep_regs[0].diepctl = depctl;

    // Prime EP0 for the first setup packet.

    usb_ep0_expect_setup(instance);

}

void synopsysotg_irq(const struct usb_instance* instance)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    struct synopsysotg_state* state = (struct synopsysotg_state*)instance->driver_state;

    union synopsysotg_gintsts gintsts = data->core->gregs.gintsts;

    if (gintsts.b.usbreset)

    {

        data->core->dregs.dcfg.b.devaddr = 0;

        usb_handle_bus_reset(instance, 0);

    }

    if (gintsts.b.enumdone)

    {

        synopsysotg_ep0_init(instance);

        usb_handle_bus_reset(instance, data->core->dregs.dsts.b.enumspd == 0);

    }

    if (gintsts.b.rxstsqlvl)

    {

        // Device to memory part of the "software DMA" implementation, used to receive data if use_dma == 0.

        // Handle one packet at a time, the IRQ will re-trigger if there's something left.

        union synopsysotg_grxfsts rxsts = data->core->gregs.grxstsp;

        int ep = rxsts.b.chnum;

        int words = (rxsts.b.bcnt + 3) >> 2;

        while (words--) *state->endpoints[ep].rxaddr++ = data->core->dfifo[0][0];

    }

    if (gintsts.b.nptxfempty && data->core->gregs.gintmsk.b.nptxfempty)

    {

        // Old style, "shared TX FIFO" memory to device part of the "software DMA" implementation,

        // used to send data if use_dma == 0 and the device doesn't support one non-periodic TX FIFO per endpoint.

        // First disable the IRQ, it will be re-enabled later if there is anything left to be done.

        data->core->gregs.gintmsk.b.nptxfempty = false;

        // Check all endpoints for anything to be transmitted

        int ep;

        for (ep = 0; ep < 16; ep++) synopsysotg_try_push(instance, ep);

    }

    if (gintsts.b.inepintr)

    {

        union synopsysotg_daint daint = data->core->dregs.daint;

        int ep;

        for (ep = 0; ep < 16; ep++)

            if (daint.ep.in & (1 << ep))

            {

                union synopsysotg_diepintn epints = data->core->inep_regs[ep].diepint;

                if (epints.b.emptyintr)

                {

                    // Memory to device part of the "software DMA" implementation, used to transmit data if use_dma == 0.

                    union synopsysotg_depxfrsiz deptsiz = data->core->inep_regs[ep].dieptsiz;

                    if (!deptsiz.b.xfersize) data->core->dregs.diepempmsk.ep.in &= ~(1 << ep);

                    else

                    {

                        // Push data into the TX FIFO until we don't have anything left or the FIFO would overflow.

                        int left = (deptsiz.b.xfersize + 3) >> 2;

                        while (left)

                        {

                            int words = data->core->inep_regs[ep].dtxfsts.b.txfspcavail;

                            if (words > left) words = left;

                            if (!words) break;

                            left -= words;

                            while (words--) data->core->dfifo[ep][0] = *state->endpoints[ep].txaddr++;

                        }

                    }

                }

                union usb_endpoint_number epnum = { .direction = USB_ENDPOINT_DIRECTION_IN, .number = ep };

                int bytesleft = data->core->inep_regs[ep].dieptsiz.b.xfersize;

                if (epints.b.timeout) usb_handle_timeout(instance, epnum, bytesleft);

                if (epints.b.xfercompl) usb_handle_xfer_complete(instance, epnum, bytesleft);

                data->core->inep_regs[ep].diepint = epints;

            }

    }

    if (gintsts.b.outepintr)

    {

        union synopsysotg_daint daint = data->core->dregs.daint;

        int ep;

        for (ep = 0; ep < 16; ep++)

            if (daint.ep.out & (1 << ep))

            {

                union synopsysotg_doepintn epints = data->core->outep_regs[ep].doepint;

                union usb_endpoint_number epnum = { .direction = USB_ENDPOINT_DIRECTION_OUT, .number = ep };

                if (epints.b.setup)

                {

                    if (data->use_dma) invalidate_dcache(instance->buffer, sizeof(instance->buffer));

                    union synopsysotg_dep0xfrsiz deptsiz = { .d32 = data->core->outep_regs[0].doeptsiz.d32 };

                    int back2back = 3 - deptsiz.b.supcnt;

                    synopsysotg_flush_in_endpoint(instance, ep);

                    usb_handle_setup_received(instance, epnum, back2back);

                }

                else if (epints.b.xfercompl)

                {

                    int bytesleft = data->core->inep_regs[ep].dieptsiz.b.xfersize;

                    usb_handle_xfer_complete(instance, epnum, bytesleft);

                }

                data->core->outep_regs[ep].doepint = epints;

            }

    }

    data->core->gregs.gintsts = gintsts;

}

void synopsysotg_init(const struct usb_instance* instance)

{

    int i;

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    // Disable IRQ during setup

    synopsysotg_target_disable_irq(instance);

    // Enable OTG clocks

    synopsysotg_target_enable_clocks(instance);

    // Enable PHY clocks

    union synopsysotg_pcgcctl pcgcctl = { .b = {} };

    data->core->pcgcctl = pcgcctl;

    // Configure PHY type (must be done before reset)

    union synopsysotg_gccfg gccfg = { .b = { .disablevbussensing = 1, .pwdn = 0 } };

    data->core->gregs.gccfg = gccfg;

    union synopsysotg_gusbcfg gusbcfg = { .b = { .force_dev = 1, .usbtrdtim = SYNOPSYSOTG_TURNAROUND } };

    if (data->phy_16bit) gusbcfg.b.phyif = 1;

    else if (data->phy_ulpi) gusbcfg.b.ulpi_utmi_sel = 1;

    else gusbcfg.b.physel  = 1;

    data->core->gregs.gusbcfg = gusbcfg;

    // Reset the whole USB core

    union synopsysotg_grstctl grstctl = { .b = { .csftrst = 1 } };

    udelay(100);

    while (!data->core->gregs.grstctl.b.ahbidle);

    data->core->gregs.grstctl = grstctl;

    while (data->core->gregs.grstctl.b.csftrst);

    while (!data->core->gregs.grstctl.b.ahbidle);

    // Soft disconnect

    union synopsysotg_dctl dctl = { .b = { .sftdiscon = 1 } };

    data->core->dregs.dctl = dctl;

    // Configure the core

    union synopsysotg_gahbcfg gahbcfg = { .b = { .dmaenable = data->use_dma, .hburstlen = SYNOPSYSOTG_AHB_BURST_LEN, .glblintrmsk = 1 } };

    if (data->disable_double_buffering)

    {

        gahbcfg.b.nptxfemplvl_txfemplvl = 1;

        gahbcfg.b.ptxfemplvl = 1;

    }

    data->core->gregs.gahbcfg = gahbcfg;

    data->core->gregs.gusbcfg = gusbcfg;

    gccfg.b.pwdn = 1;

    data->core->gregs.gccfg = gccfg;

    union synopsysotg_dcfg dcfg = { .b = { .nzstsouthshk = 1 } };

    data->core->dregs.dcfg = dcfg;

    // Configure the FIFOs

    if (data->use_dma)

    {

        union synopsysotg_dthrctl dthrctl = { .b = { .arb_park_en = 1, .rx_thr_en = 1, .iso_thr_en = 0, .non_iso_thr_en = 0,

                                                     .rx_thr_len = SYNOPSYSOTG_AHB_THRESHOLD } };

        data->core->dregs.dthrctl = dthrctl;

    }

    int addr = data->fifosize;

    for (i = 0; i < 16; i++)

    {

        int size = data->txfifosize[i];

        addr -= size;

        if (size)

        {

            data->core->inep_regs[i].diepctl.b.nextep = (i + 1) & 0xf;

            union synopsysotg_txfsiz fsiz = { .b = { .startaddr = addr, .depth = size } };

            if (!i) data->core->gregs.dieptxf0_hnptxfsiz = fsiz;

            else data->core->gregs.dieptxf[i - 1] = fsiz;

        }

    }

    union synopsysotg_rxfsiz fsiz = { .b = { .depth = addr } };

    data->core->gregs.grxfsiz = fsiz;

    // Set up interrupts

    union synopsysotg_doepintn doepmsk =  { .b = { .xfercompl = 1, .setup = 1 } };

    data->core->dregs.doepmsk = doepmsk;

    union synopsysotg_diepintn diepmsk =  { .b = { .xfercompl = 1, .timeout = 1 } };

    data->core->dregs.diepmsk = diepmsk;

    data->core->dregs.diepempmsk.d32 = 0;

    union synopsysotg_daint daintmsk = { .ep = { .in = 0b0000000000000001, .out = 0b0000000000000001 } };

    data->core->dregs.daintmsk = daintmsk;

    union synopsysotg_gintmsk gintmsk =  { .b = { .usbreset = 1, .enumdone = 1, .outepintr = 1, .inepintr = 1 } };

    if (!data->use_dma) gintmsk.b.rxstsqlvl = 1;

    data->core->gregs.gintmsk = gintmsk;

    synopsysotg_flush_ints(instance);

    synopsysotg_target_clear_irq(instance);

    synopsysotg_target_enable_irq(instance);

    // Soft reconnect

    dctl.b.sftdiscon = 0;

    data->core->dregs.dctl = dctl;

}

void synopsysotg_exit(const struct usb_instance* instance)

{

    const struct synopsysotg_config* data = (const struct synopsysotg_config*)instance->driver_config;

    // Soft disconnect

    union synopsysotg_dctl dctl = { .b = { .sftdiscon = 1 } };

    data->core->dregs.dctl = dctl;

    // Disable IRQs

    synopsysotg_target_disable_irq(instance);

    // Disable clocks

    synopsysotg_target_disable_clocks(instance);

}

int synopsysotg_get_max_transfer_size(const struct usb_instance* data, union usb_endpoint_number ep)

{

    return 512;

}

const struct usb_driver synopsysotg_driver =

{

    .init = synopsysotg_init,

    .exit = synopsysotg_exit,

    .ep0_start_rx = synopsysotg_ep0_start_rx,

    .ep0_start_tx = synopsysotg_ep0_start_tx,

    .start_rx = synopsysotg_start_rx,

    .start_tx = synopsysotg_start_tx,

    .get_stall = synopsysotg_get_stall,

    .set_stall = synopsysotg_set_stall,

    .set_address = synopsysotg_set_address,

    .configure_ep = synopsysotg_configure_ep,

    .unconfigure_ep = synopsysotg_unconfigure_ep,

    .get_max_transfer_size = synopsysotg_get_max_transfer_size,

};