JBBoardに接続したモーター2つをRCBControllerでコントロールするテストです。
Dependencies: FatFileSystem TB6612FNG2 mbed
Fork of BTstackLE by
usb/UsbHostMgr2.cpp@7:3ed1e36587d4, 2014-05-12 (annotated)
- Committer:
- jksoft
- Date:
- Mon May 12 14:24:35 2014 +0000
- Revision:
- 7:3ed1e36587d4
- Parent:
- 0:1ed23ab1345f
First edition
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
va009039 | 0:1ed23ab1345f | 1 | #include "UsbHostMgr.h" |
va009039 | 0:1ed23ab1345f | 2 | //#define __DEBUG |
va009039 | 0:1ed23ab1345f | 3 | #include "mydbg.h" |
va009039 | 0:1ed23ab1345f | 4 | |
va009039 | 0:1ed23ab1345f | 5 | UsbDevice* UsbHostMgr::getDeviceByClass(uint8_t IfClass, int count) |
va009039 | 0:1ed23ab1345f | 6 | { |
va009039 | 0:1ed23ab1345f | 7 | DBG("IfClass=%02X count=%d\n", IfClass, count); |
va009039 | 0:1ed23ab1345f | 8 | for(int i = 0; i < USB_HOSTMGR_MAX_DEVS; i++) { |
va009039 | 0:1ed23ab1345f | 9 | UsbDevice* dev = m_lpDevices[i]; |
va009039 | 0:1ed23ab1345f | 10 | if (dev) { |
va009039 | 0:1ed23ab1345f | 11 | if(dev->m_connected && dev->m_enumerated) { |
va009039 | 0:1ed23ab1345f | 12 | if (dev->m_InterfaceClass == IfClass) { // found |
va009039 | 0:1ed23ab1345f | 13 | if (count-- <= 0) { |
va009039 | 0:1ed23ab1345f | 14 | return dev; |
va009039 | 0:1ed23ab1345f | 15 | } |
va009039 | 0:1ed23ab1345f | 16 | } |
va009039 | 0:1ed23ab1345f | 17 | } |
va009039 | 0:1ed23ab1345f | 18 | } |
va009039 | 0:1ed23ab1345f | 19 | } |
va009039 | 0:1ed23ab1345f | 20 | return NULL; |
va009039 | 0:1ed23ab1345f | 21 | } |
va009039 | 0:1ed23ab1345f | 22 | |
va009039 | 0:1ed23ab1345f | 23 | void UsbHostMgr::onUsbDeviceConnected(int hub, int port) |
va009039 | 0:1ed23ab1345f | 24 | { |
va009039 | 0:1ed23ab1345f | 25 | DBG("%p hub=%d port=%d\n", this, hub, port); |
va009039 | 0:1ed23ab1345f | 26 | for(int i = 0; i < USB_HOSTMGR_MAX_DEVS; i++) { |
va009039 | 0:1ed23ab1345f | 27 | UsbDevice* dev = m_lpDevices[i]; |
va009039 | 0:1ed23ab1345f | 28 | if (dev) { |
va009039 | 0:1ed23ab1345f | 29 | if (dev->m_hub == hub && dev->m_port == port) { // skip |
va009039 | 0:1ed23ab1345f | 30 | return; |
va009039 | 0:1ed23ab1345f | 31 | } |
va009039 | 0:1ed23ab1345f | 32 | } |
va009039 | 0:1ed23ab1345f | 33 | } |
va009039 | 0:1ed23ab1345f | 34 | |
va009039 | 0:1ed23ab1345f | 35 | int item = devicesCount(); |
va009039 | 0:1ed23ab1345f | 36 | DBG_ASSERT(item < USB_HOSTMGR_MAX_DEVS); |
va009039 | 0:1ed23ab1345f | 37 | if( item == USB_HOSTMGR_MAX_DEVS ) |
va009039 | 0:1ed23ab1345f | 38 | return; //List full... |
va009039 | 0:1ed23ab1345f | 39 | //Find a free address (not optimized, but not really important) |
va009039 | 0:1ed23ab1345f | 40 | int addr = 1; |
va009039 | 0:1ed23ab1345f | 41 | for(int i = 0; i < item; i++) |
va009039 | 0:1ed23ab1345f | 42 | { |
va009039 | 0:1ed23ab1345f | 43 | DBG_ASSERT(m_lpDevices[i]); |
va009039 | 0:1ed23ab1345f | 44 | addr = MAX( addr, m_lpDevices[i]->m_addr + 1 ); |
va009039 | 0:1ed23ab1345f | 45 | } |
va009039 | 0:1ed23ab1345f | 46 | DBG("item=%d addr=%d\n", item, addr); |
va009039 | 0:1ed23ab1345f | 47 | UsbDevice* dev = new UsbDevice( this, hub, port, addr ); |
va009039 | 0:1ed23ab1345f | 48 | DBG_ASSERT(dev); |
va009039 | 0:1ed23ab1345f | 49 | dev->m_connected = true; |
va009039 | 0:1ed23ab1345f | 50 | m_lpDevices[item] = dev; |
va009039 | 0:1ed23ab1345f | 51 | } |