This commit is contained in:
Oleg Mazurov 2011-07-01 20:25:50 -06:00
parent ce6aa49501
commit 77f64ce1cd
4 changed files with 153 additions and 268 deletions

389
adk.cpp
View file

@ -12,7 +12,8 @@ ADK::ADK(USB *p, const char* manufacturer,
const char* uri, const char* uri,
const char* serial) : const char* serial) :
pUsb(p), //pointer to USB class instance - mandatory for each driver pUsb(p), //pointer to USB class instance - mandatory
/* ADK ID Strings */
manufacturer(manufacturer), manufacturer(manufacturer),
model(model), model(model),
description(description), description(description),
@ -20,8 +21,8 @@ ADK::ADK(USB *p, const char* manufacturer,
uri(uri), uri(uri),
serial(serial), serial(serial),
bAddress(0), //device address - mandatory for each driver bAddress(0), //device address - mandatory
bNumEP(1) //if config descriptor needs to be parsed bNumEP(1) //if config descriptor needs to be parsed
{ {
/* initialize endpoint data structures */ /* initialize endpoint data structures */
for(uint8_t i=0; i<ADK_MAX_ENDPOINTS; i++) for(uint8_t i=0; i<ADK_MAX_ENDPOINTS; i++)
@ -30,17 +31,16 @@ ADK::ADK(USB *p, const char* manufacturer,
epInfo[i].maxPktSize = (i) ? 0 : 8; epInfo[i].maxPktSize = (i) ? 0 : 8;
epInfo[i].epAttribs = 0; epInfo[i].epAttribs = 0;
if (!i) if (!i) {
epInfo[i].bmNakPower = USB_NAK_MAX_POWER; epInfo[i].bmNakPower = USB_NAK_MAX_POWER;
}
}
if (pUsb) {
pUsb->RegisterDeviceClass(this); //set devConfig[] entry
} }
if (pUsb)
pUsb->RegisterDeviceClass(this);
} }
/* Android initialization. Performed in 2 steps:
1. If new device answers to vendor-specific request, another request switched device to accessory mode. /* Connect/disconnect initialization of a phone */
The device is then reset and comes up on a bus with different VID/PID.
2. After detecting by VID/PID enpoints are extracted and device is configured
*/
uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed) uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
{ {
const uint8_t constBufSize = sizeof(USB_DEVICE_DESCRIPTOR); const uint8_t constBufSize = sizeof(USB_DEVICE_DESCRIPTOR);
@ -56,16 +56,22 @@ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
USBTRACE("\r\nADK Init"); USBTRACE("\r\nADK Init");
// check if address has already been assigned to an instance // check if address has already been assigned to an instance
if (bAddress) if (bAddress) {
USBTRACE("\r\nAddress in use");
return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE; return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE;
}
//USBTRACE("\r\nHere");
// Get pointer to pseudo device with address 0 assigned // Get pointer to pseudo device with address 0 assigned
p = addrPool.GetUsbDevicePtr(0); p = addrPool.GetUsbDevicePtr(0);
if (!p) if (!p) {
USBTRACE("\r\nAddress not found");
return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL; return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
}
if (!p->epinfo) { if (!p->epinfo) {
USBTRACE("epinfo is null\r\n"); USBTRACE("epinfo is null\r\n");
@ -90,27 +96,57 @@ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
goto FailGetDevDescr; goto FailGetDevDescr;
} }
// Allocate new address according to device class // Allocate new address according to device class
bAddress = addrPool.AllocAddress(parent, false, port); bAddress = addrPool.AllocAddress(parent, false, port);
if (!bAddress) {
return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // Extract Max Packet Size from device descriptor
} epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0;
// Assign new address to the device
rcode = pUsb->setAddr( 0, 0, bAddress );
if (rcode)
{
p->lowspeed = false;
addrPool.FreeAddress(bAddress);
bAddress = 0;
USBTRACE2("setAddr:",rcode);
return rcode;
}
USBTRACE2("\r\nAddr:", bAddress);
p->lowspeed = false;
//get pointer to assigned address record
p = addrPool.GetUsbDevicePtr(bAddress);
if (!p) {
return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
}
p->lowspeed = lowspeed;
// Assign epInfo to epinfo pointer
rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo);
if (rcode)
goto FailSetDevTblEntry;
// Extract Max Packet Size from the device descriptor
epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0;
/* debug code start */ /* debug code start */
num_of_conf = ((USB_DEVICE_DESCRIPTOR*)buf)->bNumConfigurations; num_of_conf = ((USB_DEVICE_DESCRIPTOR*)buf)->bNumConfigurations;
USBTRACE2("\r\nNum.conf: ", num_of_conf );
for (uint8_t i=0; i<num_of_conf; i++) {
//USBTRACE("\r\nHexdumper: ");
HexDumper<USBReadParser, uint16_t, uint16_t> HexDump;
//USBTRACE("\r\nHexdumper2: ");
//ConfigDescParser<0, 0, 0,
// 0> confDescrParser(this);
rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump); USBTRACE2("\r\nNC:",num_of_conf);
//rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser); USBTRACE2("\r\nNP:",epInfo[0].bmNakPower);
for (uint8_t i=0; i<num_of_conf; i++)
{
USBTRACE("\r\nHexdumper: ");
HexDumper<USBReadParser, uint16_t, uint16_t> HexDump;
//ConfigDescParser<0, 0, 0, 0> confDescrParser(this);
rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump);
//rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser);
} // for (uint8_t i=0; i<num_of_conf; i++... } // for (uint8_t i=0; i<num_of_conf; i++...
@ -122,61 +158,20 @@ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
(((USB_DEVICE_DESCRIPTOR*)buf)->idProduct == ADK_PID || ((USB_DEVICE_DESCRIPTOR*)buf)->idProduct == ADB_PID)){ (((USB_DEVICE_DESCRIPTOR*)buf)->idProduct == ADK_PID || ((USB_DEVICE_DESCRIPTOR*)buf)->idProduct == ADB_PID)){
USBTRACE("\r\nAcc.mode device detected"); USBTRACE("\r\nAcc.mode device detected");
/* set endpoint info, config */
// Allocate new address // Allocate new address
//bAddress = addrPool.AllocAddress(parent, false, port); //bAddress = addrPool.AllocAddress(parent, false, port);
if (!bAddress) { //if (!bAddress) {
return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL; // return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL;
} //}
// Extract Max Packet Size from the device descriptor // Extract Max Packet Size from the device descriptor
epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0; //epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0;
// Set Configuration Value
// Assign new address to the device
rcode = pUsb->setAddr( 0, 0, bAddress );
if (rcode) {
p->lowspeed = false;
addrPool.FreeAddress(bAddress);
bAddress = 0;
USBTRACE2("setAddr:",rcode);
return rcode;
}
USBTRACE2("\r\nAddr: ", bAddress);
p->lowspeed = false;
p = addrPool.GetUsbDevicePtr(bAddress);
if (!p) {
return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
}
p->lowspeed = lowspeed;
// Assign epInfo to epinfo pointer
// rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo);
/*
if (rcode) {
goto FailSetDevTblEntry;
}
*/
/* initialize endpoint structures */
// Assign epInfo to epinfo pointer
//rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo);
USBTRACE2("Conf:", 1);
// Set Configuration Value
rcode = pUsb->setConf(bAddress, 0, bConfNum); rcode = pUsb->setConf(bAddress, 0, bConfNum);
if (rcode) {
goto FailSetConf;
}
return 0; //successful configuration return 0; //successful configuration
}//if( buf->idVendor == ADK_VID... }//if( buf->idVendor == ADK_VID...
@ -190,7 +185,16 @@ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
USBTRACE2("\r\nADK protocol rev. ", adkproto ); USBTRACE2("\r\nADK protocol rev. ", adkproto );
} }
//load ID strings and switch to accessory mode //sending ID strings
sendStr( ACCESSORY_STRING_MANUFACTURER, manufacturer);
sendStr( ACCESSORY_STRING_MODEL, model);
sendStr( ACCESSORY_STRING_DESCRIPTION, description);
sendStr( ACCESSORY_STRING_VERSION, version);
sendStr( ACCESSORY_STRING_URI, uri);
sendStr( ACCESSORY_STRING_SERIAL, serial);
//switch to accessory mode
//the phone will reset
rcode = switchAcc(); rcode = switchAcc();
if( rcode ) { if( rcode ) {
goto FailSwAcc; //init fails goto FailSwAcc; //init fails
@ -198,98 +202,15 @@ uint8_t ADK::Init(uint8_t parent, uint8_t port, bool lowspeed)
rcode = -1; rcode = -1;
goto SwAttempt; //switch to accessory mode attempted goto SwAttempt; //switch to accessory mode attempted
//
// // Allocate new address according to device class
// bAddress = addrPool.AllocAddress(parent, false, port);
//
// if (!bAddress)
// return USB_ERROR_OUT_OF_ADDRESS_SPACE_IN_POOL;
//
// // Extract Max Packet Size from the device descriptor
// epInfo[0].maxPktSize = (uint8_t)((USB_DEVICE_DESCRIPTOR*)buf)->bMaxPacketSize0;
//
// // Assign new address to the device
// rcode = pUsb->setAddr( 0, 0, bAddress );
//
// if (rcode)
// {
// p->lowspeed = false;
// addrPool.FreeAddress(bAddress);
// bAddress = 0;
// USBTRACE2("setAddr:",rcode);
// return rcode;
// }
//
// USBTRACE2("Addr:", bAddress);
//
// p->lowspeed = false;
//
// p = addrPool.GetUsbDevicePtr(bAddress);
//
// if (!p)
// return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
//
// p->lowspeed = lowspeed;
//
// num_of_conf = ((USB_DEVICE_DESCRIPTOR*)buf)->bNumConfigurations;
//
// // Assign epInfo to epinfo pointer
// rcode = pUsb->setEpInfoEntry(bAddress, 1, epInfo);
//
// if (rcode)
// goto FailSetDevTblEntry;
//
// USBTRACE2("NC:", num_of_conf);
//
// for (uint8_t i=0; i<num_of_conf; i++)
// {
// ConfigDescParser< USB_CLASS_COM_AND_CDC_CTRL,
// CDC_SUBCLASS_ACM,
// CDC_PROTOCOL_ITU_T_V_250,
// CP_MASK_COMPARE_CLASS |
// CP_MASK_COMPARE_SUBCLASS |
// CP_MASK_COMPARE_PROTOCOL> CdcControlParser(this);
//
// ConfigDescParser<USB_CLASS_CDC_DATA, 0, 0,
// CP_MASK_COMPARE_CLASS> CdcDataParser(this);
//
// rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcControlParser);
// rcode = pUsb->getConfDescr(bAddress, 0, i, &CdcDataParser);
//
// if (bNumEP > 1)
// break;
// } // for
//
// if (bNumEP < 4)
// return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED;
//
// // Assign epInfo to epinfo pointer
// rcode = pUsb->setEpInfoEntry(bAddress, bNumEP, epInfo);
//
// USBTRACE2("Conf:", bConfNum);
//
// // Set Configuration Value
// rcode = pUsb->setConf(bAddress, 0, bConfNum);
//
// if (rcode)
// goto FailSetConf;
//
// rcode = pAsync->OnInit(this);
//
// if (rcode)
// goto FailOnInit;
//
// USBTRACE("ACM configured\r\n");
//
// //bPollEnable = true;
//
// //USBTRACE("Poll enabled\r\n");
// return 0;
//
FailGetDevDescr: FailGetDevDescr:
USBTRACE("\r\ngetDevDescr:"); USBTRACE("\r\ngetDevDescr:");
goto Fail; goto Fail;
FailSetDevTblEntry:
USBTRACE("\r\nsetDevTblEn:");
goto Fail;
FailGetProto: FailGetProto:
USBTRACE("\r\ngetProto:"); USBTRACE("\r\ngetProto:");
goto Fail; goto Fail;
@ -310,9 +231,9 @@ SwAttempt:
// USBTRACE("getConf:"); // USBTRACE("getConf:");
// goto Fail; // goto Fail;
// //
FailSetConf: //FailSetConf:
USBTRACE("\r\nsetConf: "); // USBTRACE("setConf:");
goto Fail; // goto Fail;
// //
//FailOnInit: //FailOnInit:
// USBTRACE("OnInit:"); // USBTRACE("OnInit:");
@ -324,44 +245,44 @@ Fail:
return rcode; return rcode;
} }
/* Extracts bulk-IN and bulk-OUT endpoint information from config descriptor */
void ADK::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep)
{
ErrorMessage<uint8_t>(PSTR("Conf.Val"), conf);
ErrorMessage<uint8_t>(PSTR("Iface Num"),iface);
ErrorMessage<uint8_t>(PSTR("Alt.Set"), alt);
//void ACM::EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *pep) bConfNum = conf;
//{
// ErrorMessage<uint8_t>(PSTR("Conf.Val"), conf);
// ErrorMessage<uint8_t>(PSTR("Iface Num"),iface);
// ErrorMessage<uint8_t>(PSTR("Alt.Set"), alt);
//
// bConfNum = conf;
//
// uint8_t index;
//
// if ((pep->bmAttributes & 0x03) == 3 && (pep->bEndpointAddress & 0x80) == 0x80)
// index = epInterruptInIndex;
// else
// if ((pep->bmAttributes & 0x02) == 2)
// index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex;
// else
// return;
//
// // Fill in the endpoint info structure
// epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F);
// epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize;
// epInfo[index].epAttribs = 0;
//
// bNumEP ++;
//
// PrintEndpointDescriptor(pep);
//}
uint8_t index;
if ((pep->bmAttributes & 0x02) == 2) {
index = ((pep->bEndpointAddress & 0x80) == 0x80) ? epDataInIndex : epDataOutIndex;
}
// Fill in the endpoint info structure
epInfo[index].epAddr = (pep->bEndpointAddress & 0x0F);
epInfo[index].maxPktSize = (uint8_t)pep->wMaxPacketSize;
epInfo[index].epAttribs = 0;
bNumEP ++;
PrintEndpointDescriptor(pep);
}
/* Performs a cleanup after failed Init() attempt */
uint8_t ADK::Release() uint8_t ADK::Release()
{ {
// pUsb->GetAddressPool().FreeAddress(bAddress); pUsb->GetAddressPool().FreeAddress(bAddress);
// //
// bControlIface = 0; // bControlIface = 0;
// bDataIface = 0; // bDataIface = 0;
// bNumEP = 1; //must have to be reset to 1 bNumEP = 1; //must have to be reset to 1
// //
// bAddress = 0; bAddress = 0;
// qNextPollTime = 0; // qNextPollTime = 0;
// bPollEnable = false; // bPollEnable = false;
return 0; return 0;
@ -414,56 +335,20 @@ uint8_t ADK::SndData(uint16_t nbytes, uint8_t *dataptr)
return pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, nbytes, dataptr); return pUsb->outTransfer(bAddress, epInfo[epDataOutIndex].epAddr, nbytes, dataptr);
} }
//uint8_t ACM::SetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr) void ADK::PrintEndpointDescriptor( const USB_ENDPOINT_DESCRIPTOR* ep_ptr )
//{ {
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCOUT, CDC_SET_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, nbytes, nbytes, dataptr, NULL )); Notify(PSTR("Endpoint descriptor:"));
//} Notify(PSTR("\r\nLength:\t\t"));
// PrintHex<uint8_t>(ep_ptr->bLength);
//uint8_t ACM::GetCommFeature(uint16_t fid, uint8_t nbytes, uint8_t *dataptr) Notify(PSTR("\r\nType:\t\t"));
//{ PrintHex<uint8_t>(ep_ptr->bDescriptorType);
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCIN, CDC_GET_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, nbytes, nbytes, dataptr, NULL )); Notify(PSTR("\r\nAddress:\t"));
//} PrintHex<uint8_t>(ep_ptr->bEndpointAddress);
// Notify(PSTR("\r\nAttributes:\t"));
//uint8_t ACM::ClearCommFeature(uint16_t fid) PrintHex<uint8_t>(ep_ptr->bmAttributes);
//{ Notify(PSTR("\r\nMaxPktSize:\t"));
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCOUT, CDC_CLEAR_COMM_FEATURE, (fid & 0xff), (fid >> 8), bControlIface, 0, 0, NULL, NULL )); PrintHex<uint16_t>(ep_ptr->wMaxPacketSize);
//} Notify(PSTR("\r\nPoll Intrv:\t"));
// PrintHex<uint8_t>(ep_ptr->bInterval);
//uint8_t ACM::SetLineCoding(const LINE_CODING *dataptr) Notify(PSTR("\r\n"));
//{ }
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCOUT, CDC_SET_LINE_CODING, 0x00, 0x00, bControlIface, sizeof(LINE_CODING), sizeof(LINE_CODING), (uint8_t*)dataptr, NULL ));
//}
//
//uint8_t ACM::GetLineCoding(LINE_CODING *dataptr)
//{
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCIN, CDC_GET_LINE_CODING, 0x00, 0x00, bControlIface, sizeof(LINE_CODING), sizeof(LINE_CODING), (uint8_t*)dataptr, NULL ));
//}
//
//uint8_t ACM::SetControlLineState(uint8_t state)
//{
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCOUT, CDC_SET_CONTROL_LINE_STATE, state, 0, bControlIface, 0, 0, NULL, NULL ));
//}
//
//uint8_t ACM::SendBreak(uint16_t duration)
//{
// return( pUsb->ctrlReq( bAddress, 0, bmREQ_CDCOUT, CDC_SEND_BREAK, (duration & 0xff), (duration >> 8), bControlIface, 0, 0, NULL, NULL ));
//}
//
//
//void ACM::PrintEndpointDescriptor( const USB_ENDPOINT_DESCRIPTOR* ep_ptr )
//{
// Notify(PSTR("Endpoint descriptor:"));
// Notify(PSTR("\r\nLength:\t\t"));
// PrintHex<uint8_t>(ep_ptr->bLength);
// Notify(PSTR("\r\nType:\t\t"));
// PrintHex<uint8_t>(ep_ptr->bDescriptorType);
// Notify(PSTR("\r\nAddress:\t"));
// PrintHex<uint8_t>(ep_ptr->bEndpointAddress);
// Notify(PSTR("\r\nAttributes:\t"));
// PrintHex<uint8_t>(ep_ptr->bmAttributes);
// Notify(PSTR("\r\nMaxPktSize:\t"));
// PrintHex<uint16_t>(ep_ptr->wMaxPacketSize);
// Notify(PSTR("\r\nPoll Intrv:\t"));
// PrintHex<uint8_t>(ep_ptr->bInterval);
// Notify(PSTR("\r\n"));
//}

6
adk.h
View file

@ -76,7 +76,7 @@ protected:
/* Endpoint data structure */ /* Endpoint data structure */
EpInfo epInfo[ADK_MAX_ENDPOINTS]; EpInfo epInfo[ADK_MAX_ENDPOINTS];
// void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr); void PrintEndpointDescriptor(const USB_ENDPOINT_DESCRIPTOR* ep_ptr);
public: public:
ADK(USB *pUsb, const char* manufacturer, ADK(USB *pUsb, const char* manufacturer,
@ -97,8 +97,8 @@ public:
virtual uint8_t Poll(); virtual uint8_t Poll();
virtual uint8_t GetAddress() { return bAddress; }; virtual uint8_t GetAddress() { return bAddress; };
// UsbConfigXtracter implementation //UsbConfigXtracter implementation
// virtual void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep); virtual void EndpointXtract(uint8_t conf, uint8_t iface, uint8_t alt, uint8_t proto, const USB_ENDPOINT_DESCRIPTOR *ep);
}; //class ADK : public USBDeviceConfig ... }; //class ADK : public USBDeviceConfig ...
/* get ADK protocol version */ /* get ADK protocol version */
/* returns 2 bytes in *adkproto */ /* returns 2 bytes in *adkproto */

6
hid.h
View file

@ -10,9 +10,9 @@
#include "Usb.h" #include "Usb.h"
#include <WProgram.h> #include <WProgram.h>
#include "..\DebugTools\printhex.h" #include "printhex.h"
#include "..\DebugTools\hexdump.h" #include "hexdump.h"
#include "..\DebugTools\message.h" #include "message.h"
#include "confdescparser.h" #include "confdescparser.h"

View file

@ -10,9 +10,9 @@
#include "Usb.h" #include "Usb.h"
#include <WProgram.h> #include <WProgram.h>
#include "..\DebugTools\printhex.h" #include "printhex.h"
#include "..\DebugTools\hexdump.h" #include "hexdump.h"
#include "..\DebugTools\message.h" #include "message.h"
#include "confdescparser.h" #include "confdescparser.h"