Takao Aratani / uvchost

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   WebCamera_SD

Fork of uvchost by Norimasa Okamoto

usb/UsbEndpoint2.cpp@0:b0f04c137829, 2012-07-31 (annotated)

Committer:
va009039
Date:
Tue Jul 31 13:58:03 2012 +0000
Revision:
0:b0f04c137829
fix probe commit control

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:b0f04c137829 1 /*
va009039 0:b0f04c137829 2 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
va009039 0:b0f04c137829 3
va009039 0:b0f04c137829 4 Permission is hereby granted, free of charge, to any person obtaining a copy
va009039 0:b0f04c137829 5 of this software and associated documentation files (the "Software"), to deal
va009039 0:b0f04c137829 6 in the Software without restriction, including without limitation the rights
va009039 0:b0f04c137829 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
va009039 0:b0f04c137829 8 copies of the Software, and to permit persons to whom the Software is
va009039 0:b0f04c137829 9 furnished to do so, subject to the following conditions:
va009039 0:b0f04c137829 10
va009039 0:b0f04c137829 11 The above copyright notice and this permission notice shall be included in
va009039 0:b0f04c137829 12 all copies or substantial portions of the Software.
va009039 0:b0f04c137829 13
va009039 0:b0f04c137829 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
va009039 0:b0f04c137829 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
va009039 0:b0f04c137829 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
va009039 0:b0f04c137829 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
va009039 0:b0f04c137829 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
va009039 0:b0f04c137829 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
va009039 0:b0f04c137829 20 THE SOFTWARE.
va009039 0:b0f04c137829 21 */
va009039 0:b0f04c137829 22 #include "UsbEndpoint.h"
va009039 0:b0f04c137829 23 #include "UsbDevice.h"
va009039 0:b0f04c137829 24 #include "usb_mem.h"
va009039 0:b0f04c137829 25
va009039 0:b0f04c137829 26 //#define __DEBUG
va009039 0:b0f04c137829 27 //#define __DEBUG3
va009039 0:b0f04c137829 28 //#include "dbg/dbg.h"
va009039 0:b0f04c137829 29 #include "mydbg.h"
va009039 0:b0f04c137829 30
va009039 0:b0f04c137829 31 void UsbEndpoint::UsbEndpoint_iso(UsbDevice* pDevice, uint8_t ep, bool dir, UsbEndpointType type, uint16_t size, int addr)
va009039 0:b0f04c137829 32 {
va009039 0:b0f04c137829 33 m_itdActive = 0;
va009039 0:b0f04c137829 34 m_pEd = (volatile HCED*)usb_get_ed();
va009039 0:b0f04c137829 35 DBG_ASSERT(m_pEd);
va009039 0:b0f04c137829 36 memset((void*)m_pEd, 0, sizeof(HCED));
va009039 0:b0f04c137829 37
va009039 0:b0f04c137829 38 m_pTdHead = NULL;
va009039 0:b0f04c137829 39 m_pTdTail = NULL;
va009039 0:b0f04c137829 40
va009039 0:b0f04c137829 41 volatile HCTD* itd = (volatile HCTD*)usb_get_itd((uint32_t)this);
va009039 0:b0f04c137829 42 DBG_ASSERT(itd);
va009039 0:b0f04c137829 43 memset((void*)itd, 0, sizeof(HCITD));
va009039 0:b0f04c137829 44 DBG3("m_pEd =%p\n", m_pEd);
va009039 0:b0f04c137829 45 DBG3("itd =%p\n", itd);
va009039 0:b0f04c137829 46
va009039 0:b0f04c137829 47 if(addr == -1)
va009039 0:b0f04c137829 48 addr = pDevice->m_addr;
va009039 0:b0f04c137829 49
va009039 0:b0f04c137829 50 //Setup Ed
va009039 0:b0f04c137829 51 //printf("\r\n--Ep Setup--\r\n");
va009039 0:b0f04c137829 52 m_pEd->Control = addr | /* USB address */
va009039 0:b0f04c137829 53 ((ep & 0x7F) << 7) | /* Endpoint address */
va009039 0:b0f04c137829 54 ((dir?2:1) << 11) | /* direction : Out = 1, 2 = In */
va009039 0:b0f04c137829 55 (1 << 15) | /* F Format */
va009039 0:b0f04c137829 56 (size << 16); /* MaxPkt Size */
va009039 0:b0f04c137829 57
va009039 0:b0f04c137829 58 DBG3("m_pEd->Control=%08X\n", m_pEd->Control);
va009039 0:b0f04c137829 59
va009039 0:b0f04c137829 60 m_dir = dir;
va009039 0:b0f04c137829 61 m_setup = false;
va009039 0:b0f04c137829 62 m_type = type;
va009039 0:b0f04c137829 63
va009039 0:b0f04c137829 64 m_pEd->TailTd = m_pEd->HeadTd = (uint32_t)itd; //Empty TD list
va009039 0:b0f04c137829 65
va009039 0:b0f04c137829 66 DBG("Before link\n");
va009039 0:b0f04c137829 67
va009039 0:b0f04c137829 68 //printf("\r\n--Ep Reg--\r\n");
va009039 0:b0f04c137829 69 //Append Ed to Ed list
va009039 0:b0f04c137829 70 HCCA* hcca = (HCCA*)usb_get_hcca();
va009039 0:b0f04c137829 71 for(int i = 0; i < 32; i++) {
va009039 0:b0f04c137829 72 if (hcca->IntTable[i] == 0) {
va009039 0:b0f04c137829 73 hcca->IntTable[i] = (uint32_t)m_pEd;
va009039 0:b0f04c137829 74 } else {
va009039 0:b0f04c137829 75 volatile HCED* nextEd = (volatile HCED*)hcca->IntTable[i];
va009039 0:b0f04c137829 76 while(nextEd->Next && nextEd->Next != (uint32_t)m_pEd) {
va009039 0:b0f04c137829 77 nextEd = (volatile HCED*)nextEd->Next;
va009039 0:b0f04c137829 78 }
va009039 0:b0f04c137829 79 nextEd->Next = (uint32_t)m_pEd;
va009039 0:b0f04c137829 80 }
va009039 0:b0f04c137829 81 }
va009039 0:b0f04c137829 82 }
va009039 0:b0f04c137829 83
va009039 0:b0f04c137829 84 // for isochronous
va009039 0:b0f04c137829 85 UsbErr UsbEndpoint::transfer(uint16_t frame, int count, volatile uint8_t* buf, int len)
va009039 0:b0f04c137829 86 {
va009039 0:b0f04c137829 87 DBG_ASSERT(count >= 1 && count <= 8);
va009039 0:b0f04c137829 88 DBG_ASSERT(buf);
va009039 0:b0f04c137829 89 DBG_ASSERT((len % count) == 0);
va009039 0:b0f04c137829 90 HCITD *itd = (HCITD*)m_pEd->TailTd;
va009039 0:b0f04c137829 91 DBG_ASSERT(itd);
va009039 0:b0f04c137829 92 HCITD *new_itd = (HCITD*)usb_get_itd((uint32_t)this);
va009039 0:b0f04c137829 93 DBG_ASSERT(new_itd);
va009039 0:b0f04c137829 94 if (itd == NULL) {
va009039 0:b0f04c137829 95 return USBERR_ERROR;
va009039 0:b0f04c137829 96 }
va009039 0:b0f04c137829 97 DBG("itd=%p\n", itd);
va009039 0:b0f04c137829 98 DBG2("new_itd=%p\n", new_itd);
va009039 0:b0f04c137829 99 int di = 0; //DelayInterrupt
va009039 0:b0f04c137829 100 itd->Control = 0xe0000000 | // CC ConditionCode NOT ACCESSED
va009039 0:b0f04c137829 101 ((count-1) << 24) | // FC FrameCount
va009039 0:b0f04c137829 102 TD_DELAY_INT(di) | // DI DelayInterrupt
va009039 0:b0f04c137829 103 frame; // SF StartingFrame
va009039 0:b0f04c137829 104 itd->BufferPage0 = (uint32_t)buf;
va009039 0:b0f04c137829 105 itd->BufferEnd = (uint32_t)buf+len-1;
va009039 0:b0f04c137829 106 itd->Next = (uint32_t)new_itd;
va009039 0:b0f04c137829 107 uint16_t offset[8];
va009039 0:b0f04c137829 108 for(int i = 0; i < 8; i++) {
va009039 0:b0f04c137829 109 uint32_t addr = (uint32_t)buf + i*(len/count);
va009039 0:b0f04c137829 110 offset[i] = addr & 0x0fff;
va009039 0:b0f04c137829 111 if ((addr&0xfffff000) == (itd->BufferEnd&0xfffff000)) {
va009039 0:b0f04c137829 112 offset[i] |= 0x1000;
va009039 0:b0f04c137829 113 }
va009039 0:b0f04c137829 114 offset[i] |= 0xe000;
va009039 0:b0f04c137829 115 }
va009039 0:b0f04c137829 116 itd->OffsetPSW10 = (offset[1]<<16) | offset[0];
va009039 0:b0f04c137829 117 itd->OffsetPSW32 = (offset[3]<<16) | offset[2];
va009039 0:b0f04c137829 118 itd->OffsetPSW54 = (offset[5]<<16) | offset[4];
va009039 0:b0f04c137829 119 itd->OffsetPSW76 = (offset[7]<<16) | offset[6];
va009039 0:b0f04c137829 120 m_itdActive++;
va009039 0:b0f04c137829 121 DBG2("itd->Control =%08X\n", itd->Control);
va009039 0:b0f04c137829 122 DBG2("itd->BufferPage0=%08X\n", itd->BufferPage0);
va009039 0:b0f04c137829 123 DBG2("itd->Next =%08X\n", itd->Next);
va009039 0:b0f04c137829 124 DBG2("itd->BufferEnd =%08X\n", itd->BufferEnd);
va009039 0:b0f04c137829 125 DBG2("itd->OffsetPSW10=%08X\n", itd->OffsetPSW10);
va009039 0:b0f04c137829 126 DBG2("itd->OffsetPSW32=%08X\n", itd->OffsetPSW32);
va009039 0:b0f04c137829 127 DBG2("itd->OffsetPSW54=%08X\n", itd->OffsetPSW54);
va009039 0:b0f04c137829 128 DBG2("itd->OffsetPSW76=%08X\n", itd->OffsetPSW76);
va009039 0:b0f04c137829 129 m_pEd->TailTd = (uint32_t)new_itd; // start!!!
va009039 0:b0f04c137829 130 LPC_USB->HcControl |= OR_CONTROL_PLE; //Enable Periodic
va009039 0:b0f04c137829 131 return USBERR_PROCESSING;
va009039 0:b0f04c137829 132 }