|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655 |
- // usb host experiments....
-
- #include "host.h"
-
- uint32_t periodictable[32] __attribute__ ((aligned(4096), used));
- uint8_t port_state;
- #define PORT_STATE_DISCONNECTED 0
- #define PORT_STATE_DEBOUNCE 1
- #define PORT_STATE_RESET 2
- #define PORT_STATE_RECOVERY 3
- #define PORT_STATE_ACTIVE 4
- Device_t *rootdev=NULL;
- Transfer_t *async_followup_first=NULL;
- Transfer_t *async_followup_last=NULL;
- Transfer_t *periodic_followup_first=NULL;
- Transfer_t *periodic_followup_last=NULL;
-
- void setup()
- {
- // Test board has a USB data mux (this won't be on final Teensy 3.6)
- pinMode(32, OUTPUT); // pin 32 = USB switch, high=connect device
- digitalWrite(32, LOW);
- pinMode(30, OUTPUT); // pin 30 = debug info - use oscilloscope
- digitalWrite(30, LOW);
- // Teensy 3.6 has USB host power controlled by PTE6
- PORTE_PCR6 = PORT_PCR_MUX(1);
- GPIOE_PDDR |= (1<<6);
- GPIOE_PSOR = (1<<6); // turn on USB host power
- while (!Serial) ; // wait
- Serial.println("USB Host Testing");
- Serial.print("sizeof Device = ");
- Serial.println(sizeof(Device_t));
- Serial.print("sizeof Pipe = ");
- Serial.println(sizeof(Pipe_t));
- Serial.print("sizeof Transfer = ");
- Serial.println(sizeof(Transfer_t));
-
- MPU_RGDAAC0 |= 0x30000000;
- Serial.print("MPU_RGDAAC0 = ");
- Serial.println(MPU_RGDAAC0, HEX);
- MCG_C1 |= MCG_C1_IRCLKEN; // enable MCGIRCLK 32kHz
- OSC0_CR |= OSC_ERCLKEN;
- SIM_SOPT2 |= SIM_SOPT2_USBREGEN; // turn on USB regulator
- SIM_SOPT2 &= ~SIM_SOPT2_USBSLSRC; // use IRC for slow clock
- print("power up USBHS PHY");
- SIM_USBPHYCTL |= SIM_USBPHYCTL_USBDISILIM; // disable USB current limit
- //SIM_USBPHYCTL = SIM_USBPHYCTL_USBDISILIM | SIM_USBPHYCTL_USB3VOUTTRG(6); // pg 237
- SIM_SCGC3 |= SIM_SCGC3_USBHSDCD | SIM_SCGC3_USBHSPHY | SIM_SCGC3_USBHS;
- USBHSDCD_CLOCK = 33 << 2;
- print("init USBHS PHY & PLL");
- // init process: page 1681-1682
- USBPHY_CTRL_CLR = (USBPHY_CTRL_SFTRST | USBPHY_CTRL_CLKGATE); // // CTRL pg 1698
- USBPHY_TRIM_OVERRIDE_EN_SET = 1;
- USBPHY_PLL_SIC = USBPHY_PLL_SIC_PLL_POWER | USBPHY_PLL_SIC_PLL_ENABLE |
- USBPHY_PLL_SIC_PLL_DIV_SEL(1) | USBPHY_PLL_SIC_PLL_EN_USB_CLKS;
- // wait for the PLL to lock
- int count=0;
- while ((USBPHY_PLL_SIC & USBPHY_PLL_SIC_PLL_LOCK) == 0) {
- count++;
- }
- Serial.print("PLL locked, waited ");
- Serial.println(count);
- // turn on power to PHY
- USBPHY_PWD = 0;
- delay(10);
-
- // sanity check, connect 470K pullup & 100K pulldown and watch D+ voltage change
- //USBPHY_ANACTRL_CLR = (1<<10); // turn off both 15K pulldowns... works! :)
-
- // sanity check, output clocks on pin 9 for testing
- //SIM_SOPT2 = SIM_SOPT2 & (~SIM_SOPT2_CLKOUTSEL(7)) | SIM_SOPT2_CLKOUTSEL(3); // LPO 1kHz
- //SIM_SOPT2 = SIM_SOPT2 & (~SIM_SOPT2_CLKOUTSEL(7)) | SIM_SOPT2_CLKOUTSEL(2); // Flash
- //SIM_SOPT2 = SIM_SOPT2 & (~SIM_SOPT2_CLKOUTSEL(7)) | SIM_SOPT2_CLKOUTSEL(6); // XTAL
- //SIM_SOPT2 = SIM_SOPT2 & (~SIM_SOPT2_CLKOUTSEL(7)) | SIM_SOPT2_CLKOUTSEL(7); // IRC 48MHz
- //SIM_SOPT2 = SIM_SOPT2 & (~SIM_SOPT2_CLKOUTSEL(7)) | SIM_SOPT2_CLKOUTSEL(4); // MCGIRCLK
- //CORE_PIN9_CONFIG = PORT_PCR_MUX(5); // CLKOUT on PTC3 Alt5 (Arduino pin 9)
-
- print("begin ehci reset");
- USBHS_USBCMD |= USBHS_USBCMD_RST;
- count = 0;
- while (USBHS_USBCMD & USBHS_USBCMD_RST) {
- count++;
- }
- print(" reset waited ", count);
-
- for (int i=0; i < 32; i++) {
- periodictable[i] = 1;
- }
- port_state = PORT_STATE_DISCONNECTED;
-
- USBHS_USB_SBUSCFG = 1; // System Bus Interface Configuration
-
- // turn on the USBHS controller
- //USBHS_USBMODE = USBHS_USBMODE_TXHSD(5) | USBHS_USBMODE_CM(3); // host mode
- USBHS_USBMODE = USBHS_USBMODE_CM(3); // host mode
- USBHS_USBINTR = 0;
- USBHS_PERIODICLISTBASE = (uint32_t)periodictable;
- USBHS_FRINDEX = 0;
- USBHS_ASYNCLISTADDR = 0;
- USBHS_USBCMD = USBHS_USBCMD_ITC(8) | USBHS_USBCMD_RS |
- USBHS_USBCMD_ASP(3) | USBHS_USBCMD_ASPE |
- USBHS_USBCMD_FS2 | USBHS_USBCMD_FS(1); // periodic table is 32 pointers
-
- //USBHS_PORTSC1 = USBHS_PORTSC_PP;
- USBHS_PORTSC1 |= USBHS_PORTSC_PP;
- //USBHS_PORTSC1 |= USBHS_PORTSC_PFSC; // force 12 Mbit/sec
- //USBHS_PORTSC1 |= USBHS_PORTSC_PHCD; // phy off
-
- Serial.print("USBHS_ASYNCLISTADDR = ");
- Serial.println(USBHS_ASYNCLISTADDR, HEX);
- Serial.print("USBHS_PERIODICLISTBASE = ");
- Serial.println(USBHS_PERIODICLISTBASE, HEX);
- Serial.print("periodictable = ");
- Serial.println((uint32_t)periodictable, HEX);
-
- NVIC_ENABLE_IRQ(IRQ_USBHS);
- USBHS_USBINTR = USBHS_USBINTR_PCE | USBHS_USBINTR_TIE0;
- USBHS_USBINTR |= USBHS_USBINTR_UEE | USBHS_USBINTR_SEE;
- USBHS_USBINTR |= USBHS_USBINTR_AAE;
- USBHS_USBINTR |= USBHS_USBINTR_UPIE | USBHS_USBINTR_UAIE;
-
- delay(25);
- Serial.println("Plug in device...");
- digitalWrite(32, HIGH); // connect device
-
-
- delay(5000);
- Serial.println();
- Serial.println("Ring Doorbell");
- USBHS_USBCMD |= USBHS_USBCMD_IAA;
- if (rootdev) print(rootdev->control_pipe);
- }
-
- void loop()
- {
- }
-
-
- void pulse(int usec)
- {
- // connect oscilloscope to see these pulses....
- digitalWriteFast(30, HIGH);
- delayMicroseconds(usec);
- digitalWriteFast(30, LOW);
- }
-
- // EHCI registers page default
- // -------------- ---- -------
- // USBHS_USBCMD 1599 00080000 USB Command
- // USBHS_USBSTS 1602 00000000 USB Status
- // USBHS_USBINTR 1606 00000000 USB Interrupt Enable
- // USBHS_FRINDEX 1609 00000000 Frame Index Register
- // USBHS_PERIODICLISTBASE 1610 undefine Periodic Frame List Base Address
- // USBHS_ASYNCLISTADDR 1612 undefine Asynchronous List Address
- // USBHS_PORTSC1 1619 00002000 Port Status and Control
- // USBHS_USBMODE 1629 00005000 USB Mode
- // USBHS_GPTIMERnCTL 1591 00000000 General Purpose Timer n Control
-
- // PORT_STATE_DISCONNECTED 0
- // PORT_STATE_DEBOUNCE 1
- // PORT_STATE_RESET 2
- // PORT_STATE_RECOVERY 3
- // PORT_STATE_ACTIVE 4
-
- void usbhs_isr(void)
- {
- uint32_t stat = USBHS_USBSTS;
- USBHS_USBSTS = stat; // clear pending interrupts
- //stat &= USBHS_USBINTR; // mask away unwanted interrupts
- Serial.println();
- Serial.print("ISR: ");
- Serial.print(stat, HEX);
- Serial.println();
- if (stat & USBHS_USBSTS_UI) Serial.println(" USB Interrupt");
- if (stat & USBHS_USBSTS_UEI) Serial.println(" USB Error");
- if (stat & USBHS_USBSTS_PCI) Serial.println(" Port Change");
- if (stat & USBHS_USBSTS_FRI) Serial.println(" Frame List Rollover");
- if (stat & USBHS_USBSTS_SEI) Serial.println(" System Error");
- if (stat & USBHS_USBSTS_AAI) Serial.println(" Async Advance (doorbell)");
- if (stat & USBHS_USBSTS_URI) Serial.println(" Reset Recv");
- if (stat & USBHS_USBSTS_SRI) Serial.println(" SOF");
- if (stat & USBHS_USBSTS_SLI) Serial.println(" Suspend");
- if (stat & USBHS_USBSTS_HCH) Serial.println(" Host Halted");
- if (stat & USBHS_USBSTS_RCL) Serial.println(" Reclamation");
- if (stat & USBHS_USBSTS_PS) Serial.println(" Periodic Sched En");
- if (stat & USBHS_USBSTS_AS) Serial.println(" Async Sched En");
- if (stat & USBHS_USBSTS_NAKI) Serial.println(" NAK");
- if (stat & USBHS_USBSTS_UAI) Serial.println(" USB Async");
- if (stat & USBHS_USBSTS_UPI) Serial.println(" USB Periodic");
- if (stat & USBHS_USBSTS_TI0) Serial.println(" Timer0");
- if (stat & USBHS_USBSTS_TI1) Serial.println(" Timer1");
-
- if (stat & USBHS_USBSTS_UAI) {
- Serial.println("Async Followup");
-
- Transfer_t *p, *prev=NULL, *next;
-
- p = async_followup_first;
- while (p) {
-
- next = p->next_followup;
- if (followup_Transfer(p)) {
- // transfer completed
- if (prev) {
- prev->next_followup = next;
- } else {
- async_followup_first = next;
- }
- } else {
- // transfer still pending
- prev = p;
- }
- p = next;
- }
- async_followup_last = prev;
-
- }
- if (stat & USBHS_USBSTS_UPI) {
-
- }
-
- if (stat & USBHS_USBSTS_PCI) { // port change detected
- const uint32_t portstat = USBHS_PORTSC1;
- Serial.print("port change: ");
- Serial.print(portstat, HEX);
- Serial.println();
- USBHS_PORTSC1 = portstat | (USBHS_PORTSC_OCC|USBHS_PORTSC_PEC|USBHS_PORTSC_CSC);
- if (portstat & USBHS_PORTSC_OCC) {
- Serial.println(" overcurrent change");
- }
- if (portstat & USBHS_PORTSC_CSC) {
- if (portstat & USBHS_PORTSC_CCS) {
- Serial.println(" connect");
- if (port_state == PORT_STATE_DISCONNECTED
- || port_state == PORT_STATE_DEBOUNCE) {
- // 100 ms debounce (USB 2.0: TATTDB, page 150 & 188)
- port_state = PORT_STATE_DEBOUNCE;
- USBHS_GPTIMER0LD = 100000; // microseconds
- USBHS_GPTIMER0CTL =
- USBHS_GPTIMERCTL_RST | USBHS_GPTIMERCTL_RUN;
- stat &= ~USBHS_USBSTS_TI0;
- }
- // TODO: should ENHOSTDISCONDETECT be set? K66 ref, page 1701
- } else {
- Serial.println(" disconnect");
- port_state = PORT_STATE_DISCONNECTED;
- // TODO: delete & clean up device state...
- }
- }
- if (portstat & USBHS_PORTSC_PEC) {
- // PEC bit only detects disable
- Serial.println(" disable");
- } else if (port_state == PORT_STATE_RESET && portstat & USBHS_PORTSC_PE) {
- Serial.println(" port enabled");
- port_state = PORT_STATE_RECOVERY;
- // 10 ms reset recover (USB 2.0: TRSTRCY, page 151 & 188)
- USBHS_GPTIMER0LD = 10000; // microseconds
- USBHS_GPTIMER0CTL = USBHS_GPTIMERCTL_RST | USBHS_GPTIMERCTL_RUN;
- }
- if (portstat & USBHS_PORTSC_FPR) {
- Serial.println(" force resume");
-
- }
- pulse(1);
- }
- if (stat & USBHS_USBSTS_TI0) { // timer 0
- Serial.println("timer");
- pulse(2);
- if (port_state == PORT_STATE_DEBOUNCE) {
- port_state = PORT_STATE_RESET;
- USBHS_PORTSC1 |= USBHS_PORTSC_PR; // begin reset sequence
- Serial.println(" begin reset");
- } else if (port_state == PORT_STATE_RECOVERY) {
- port_state = PORT_STATE_ACTIVE;
- Serial.println(" end recovery");
-
- // HCSPARAMS TTCTRL page 1671
- uint32_t speed = (USBHS_PORTSC1 >> 26) & 3;
- rootdev = new_Device(speed, 0, 0);
- }
- }
-
- }
-
- Device_t * new_Device(uint32_t speed, uint32_t hub_addr, uint32_t hub_port)
- {
- Device_t *dev;
-
- Serial.print("new_Device: ");
- switch (speed) {
- case 0: Serial.print("12"); break;
- case 1: Serial.print("1.5"); break;
- case 2: Serial.print("480"); break;
- default: Serial.print("??");
- }
- Serial.println(" Mbit/sec");
- dev = allocate_Device();
- if (!dev) return NULL;
- dev->speed = speed;
- dev->address = 0;
- dev->hub_address = hub_addr;
- dev->hub_port = hub_port;
- dev->control_pipe = new_Pipe(dev, 0, 0, 0, 8);
- if (!dev->control_pipe) {
- free_Device(dev);
- return NULL;
- }
-
- static uint8_t buffer[8];
- dev->control_pipe->direction = 1; // 1=IN
- dev->setup.bmRequestType = 0x80;
- dev->setup.bRequest = 0x06; // 6=GET_DESCRIPTOR
- dev->setup.wValue = 0x0100;
- dev->setup.wIndex = 0x0000;
- dev->setup.wLength = 8;
- new_Transfer(dev->control_pipe, buffer, 8);
-
- return dev;
- }
-
-
-
- static uint32_t QH_capabilities1(uint32_t nak_count_reload, uint32_t control_endpoint_flag,
- uint32_t max_packet_length, uint32_t head_of_list, uint32_t data_toggle_control,
- uint32_t speed, uint32_t endpoint_number, uint32_t inactivate, uint32_t address)
- {
- return ( (nak_count_reload << 28) | (control_endpoint_flag << 27) |
- (max_packet_length << 16) | (head_of_list << 15) |
- (data_toggle_control << 14) | (speed << 12) | (endpoint_number << 8) |
- (inactivate << 7) | (address << 0) );
- }
-
- static uint32_t QH_capabilities2(uint32_t high_bw_mult, uint32_t hub_port_number,
- uint32_t hub_address, uint32_t split_completion_mask, uint32_t interrupt_schedule_mask)
- {
- return ( (high_bw_mult << 30) | (hub_port_number << 23) | (hub_address << 16) |
- (split_completion_mask << 8) | (interrupt_schedule_mask << 0) );
- }
-
- Pipe_t * new_Pipe(Device_t *dev, uint32_t type, uint32_t endpoint, uint32_t direction,
- uint32_t max_packet_len)
- {
- Pipe_t *pipe;
- Transfer_t *halt;
- uint32_t c=0, dtc=0;
-
- Serial.println("new_Pipe");
- pipe = allocate_Pipe();
- if (!pipe) return NULL;
- halt = allocate_Transfer();
- if (!halt) {
- free_Pipe(pipe);
- return NULL;
- }
- memset(pipe, 0, sizeof(Pipe_t));
- memset(halt, 0, sizeof(Transfer_t));
- halt->qtd.next = 1;
- halt->qtd.token = 0x40;
- pipe->device = dev;
- pipe->qh.next = (uint32_t)halt;
- pipe->qh.alt_next = 1;
- pipe->direction = direction;
- pipe->type = type;
- if (type == 0) {
- // control
- if (dev->speed < 2) c = 1;
- dtc = 1;
- } else if (type == 2) {
- // bulk
- } else if (type == 3) {
- // interrupt
- }
- pipe->qh.capabilities[0] = QH_capabilities1(15, c, max_packet_len, 0,
- dtc, dev->speed, endpoint, 0, dev->address);
- pipe->qh.capabilities[1] = QH_capabilities2(1, dev->hub_port,
- dev->hub_address, 0, 0);
-
- if (type == 0 || type == 2) {
- // control or bulk: add to async queue
- Pipe_t *list = (Pipe_t *)USBHS_ASYNCLISTADDR;
- if (list == NULL) {
- pipe->qh.capabilities[0] |= 0x8000; // H bit
- pipe->qh.horizontal_link = (uint32_t)&(pipe->qh) | 2; // 2=QH
- USBHS_ASYNCLISTADDR = (uint32_t)&(pipe->qh);
- USBHS_USBCMD |= USBHS_USBCMD_ASE; // enable async schedule
- Serial.println(" first in async list");
- } else {
- // EHCI 1.0: section 4.8.1, page 72
- pipe->qh.horizontal_link = list->qh.horizontal_link;
- list->qh.horizontal_link = (uint32_t)&(pipe->qh) | 2;
- Serial.println(" added to async list");
- }
- } else if (type == 3) {
- // interrupt: add to periodic schedule
- // TODO: link it into the periodic table
- }
- return pipe;
- }
-
-
-
- // Fill in the qTD fields (token & data)
- // t the Transfer qTD to initialize
- // buf data to transfer
- // len length of data
- // pid type of packet: 0=OUT, 1=IN, 2=SETUP
- // data01 value of DATA0/DATA1 toggle on 1st packet
- // irq whether to generate an interrupt when transfer complete
- //
- void init_qTD(volatile Transfer_t *t, void *buf, uint32_t len,
- uint32_t pid, uint32_t data01, bool irq)
- {
- t->qtd.alt_next = 1; // 1=terminate
- if (data01) data01 = 0x80000000;
- t->qtd.token = data01 | (len << 16) | (irq ? 0x8000 : 0) | (pid << 8) | 0x80;
- uint32_t addr = (uint32_t)buf;
- t->qtd.buffer[0] = addr;
- addr &= 0xFFFFF000;
- t->qtd.buffer[1] = addr + 0x1000;
- t->qtd.buffer[2] = addr + 0x2000;
- t->qtd.buffer[3] = addr + 0x3000;
- t->qtd.buffer[4] = addr + 0x4000;
- }
-
-
- // Create a Transfer and queue it
- //
- bool new_Transfer(Pipe_t *pipe, void *buffer, uint32_t len)
- {
- Serial.println("new_Transfer");
- Transfer_t *transfer = allocate_Transfer();
- if (!transfer) return false;
- transfer->pipe = pipe;
- if (pipe->type == 0) {
- // control transfer
- Transfer_t *data, *status;
- uint32_t status_direction;
- if (len > 16384) {
- free_Transfer(transfer);
- return false;
- }
- status = allocate_Transfer();
- if (!status) {
- free_Transfer(transfer);
- return false;
- }
- if (len > 0) {
- data = allocate_Transfer();
- if (!data) {
- free_Transfer(transfer);
- free_Transfer(status);
- return false;
- }
- init_qTD(data, buffer, len, pipe->direction, 1, false);
- transfer->qtd.next = (uint32_t)data;
- data->qtd.next = (uint32_t)status;
- data->pipe = pipe;
- status_direction = pipe->direction ^ 1;
- } else {
- transfer->qtd.next = (uint32_t)status;
- status_direction = 1; // always IN, USB 2.0 page 226
- }
- Serial.print("setup address ");
- Serial.println((uint32_t)&pipe->device->setup, HEX);
- init_qTD(transfer, &pipe->device->setup, 8, 2, 0, false);
- init_qTD(status, NULL, 0, status_direction, 1, true);
- status->pipe = pipe;
- status->qtd.next = 1;
- } else {
- // bulk, interrupt or isochronous transfer
- free_Transfer(transfer);
- return false;
- }
- // find halt qTD
- Transfer_t *halt = (Transfer_t *)(pipe->qh.next);
- while (!(halt->qtd.token & 0x40)) halt = (Transfer_t *)(halt->qtd.next);
- // transfer's token
- uint32_t token = transfer->qtd.token;
- // transfer becomes new halt qTD
- transfer->qtd.token = 0x40;
- // copy transfer non-token fields to halt
- halt->qtd.next = transfer->qtd.next;
- halt->qtd.alt_next = transfer->qtd.alt_next;
- halt->qtd.buffer[0] = transfer->qtd.buffer[0];
- halt->qtd.buffer[1] = transfer->qtd.buffer[1];
- halt->qtd.buffer[2] = transfer->qtd.buffer[2];
- halt->qtd.buffer[3] = transfer->qtd.buffer[3];
- halt->qtd.buffer[4] = transfer->qtd.buffer[4];
- halt->pipe = pipe;
- // find the last qTD we're adding
- Transfer_t *last = halt;
- while ((uint32_t)(last->qtd.next) != 1) last = (Transfer_t *)(last->qtd.next);
- // last points to transfer (which becomes new halt)
- last->qtd.next = (uint32_t)transfer;
- transfer->qtd.next = 1;
- // link all the new qTD by next_followup
- Transfer_t *p = halt;
- while (p->qtd.next != (uint32_t)transfer) {
- Transfer_t *n = (Transfer_t *)p->qtd.next;
- p->next_followup = n;
- p = n;
- }
- p->next_followup = NULL;
- // add them to a followup list
- if (pipe->type == 0 || pipe->type == 2) {
- // control or bulk
- if (async_followup_first == NULL) {
- async_followup_first = halt;
- } else {
- async_followup_last->next_followup = halt;
- }
- async_followup_last = p;
- } else {
- // interrupt
- if (periodic_followup_first == NULL) {
- periodic_followup_first = halt;
- } else {
- periodic_followup_last->next_followup = halt;
- }
- periodic_followup_last = p;
- }
- // old halt becomes new transfer, this commits all new qTDs to QH
- halt->qtd.token = token;
- return true;
- }
-
- bool followup_Transfer(Transfer_t *transfer)
- {
- Serial.print(" Followup ");
- Serial.println((uint32_t)transfer, HEX);
-
- if (!(transfer->qtd.token & 0x80)) {
- // TODO: check error status
- // do callback function...
- Serial.println(" completed");
- free_Transfer(transfer);
- return true;
-
- }
- return false;
- }
-
- void print(const Transfer_t *transfer)
- {
- if (!((uint32_t)transfer & 0xFFFFFFE0)) return;
- Serial.print("Transfer @ ");
- Serial.println(((uint32_t)transfer & 0xFFFFFFE0), HEX);
- Serial.print(" next: ");
- Serial.println(transfer->qtd.next, HEX);
- Serial.print(" anext: ");
- Serial.println(transfer->qtd.alt_next, HEX);
- Serial.print(" token: ");
- Serial.println(transfer->qtd.token, HEX);
- Serial.print(" bufs: ");
- for (int i=0; i < 5; i++) {
- Serial.print(transfer->qtd.buffer[i], HEX);
- if (i < 4) Serial.print(',');
- }
- Serial.println();
- }
-
- void print(const Pipe_t *pipe)
- {
- if (!((uint32_t)pipe & 0xFFFFFFE0)) return;
- Serial.print("Pipe ");
- if (pipe->type == 0) Serial.print("control");
- else if (pipe->type == 1) Serial.print("isochronous");
- else if (pipe->type == 2) Serial.print("bulk");
- else if (pipe->type == 3) Serial.print("interrupt");
- Serial.print(pipe->direction ? " IN" : " OUT");
- Serial.print(" @ ");
- Serial.println((uint32_t)pipe, HEX);
- Serial.print(" horiz link: ");
- Serial.println(pipe->qh.horizontal_link, HEX);
- Serial.print(" capabilities: ");
- Serial.print(pipe->qh.capabilities[0], HEX);
- Serial.print(',');
- Serial.println(pipe->qh.capabilities[1], HEX);
- Serial.println(" overlay:");
- Serial.print(" cur: ");
- Serial.println(pipe->qh.current, HEX);
- Serial.print(" next: ");
- Serial.println(pipe->qh.next, HEX);
- Serial.print(" anext: ");
- Serial.println(pipe->qh.alt_next, HEX);
- Serial.print(" token: ");
- Serial.println(pipe->qh.token, HEX);
- Serial.print(" bufs: ");
- for (int i=0; i < 5; i++) {
- Serial.print(pipe->qh.buffer[i], HEX);
- if (i < 4) Serial.print(',');
- }
- Serial.println();
- const Transfer_t *t = (Transfer_t *)pipe->qh.next;
- while (((uint32_t)t & 0xFFFFFFE0)) {
- print(t);
- t = (Transfer_t *)t->qtd.next;
- }
- //Serial.print();
- }
-
-
-
- void print(const char *s)
- {
- Serial.println(s);
- delay(10);
- }
-
- void print(const char *s, int num)
- {
- Serial.print(s);
- Serial.println(num);
- delay(10);
- }
-
-
- // Memory allocation... for now, just simplest leaky way to get started
-
- Device_t * allocate_Device(void)
- {
- static Device_t mem[3];
- static size_t count=0;
- if (count >= sizeof(mem)/sizeof(Device_t)) return NULL;
- return &mem[count++];
- }
-
- void free_Device(Device_t *q)
- {
- }
-
- Pipe_t * allocate_Pipe(void)
- {
- static Pipe_t mem[6] __attribute__ ((aligned(64)));
- static size_t count=0;
- if (count >= sizeof(mem)/sizeof(Pipe_t)) return NULL;
- return &mem[count++];
- }
-
- void free_Pipe(Pipe_t *q)
- {
- }
-
- Transfer_t * allocate_Transfer(void)
- {
- static Transfer_t mem[22] __attribute__ ((aligned(64)));
- static size_t count=0;
- if (count >= sizeof(mem)/sizeof(Transfer_t)) return NULL;
- return &mem[count++];
- }
-
- void free_Transfer(Transfer_t *q)
- {
- }
-
|