248 wiersze
6.5 KiB
C++
248 wiersze
6.5 KiB
C++
/* Copyright (C) 2011 Circuits At Home, LTD. All rights reserved.
|
|
|
|
This software may be distributed and modified under the terms of the GNU
|
|
General Public License version 2 (GPL2) as published by the Free Software
|
|
Foundation and appearing in the file GPL2.TXT included in the packaging of
|
|
this file. Please note that GPL2 Section 2[b] requires that all works based
|
|
on this software must also be made publicly available under the terms of
|
|
the GPL2 ("Copyleft").
|
|
|
|
Contact information
|
|
-------------------
|
|
|
|
Circuits At Home, LTD
|
|
Web : http://www.circuitsathome.com
|
|
e-mail : support@circuitsathome.com
|
|
*/
|
|
#include "cdcprolific.h"
|
|
|
|
PL2303::PL2303(USB *p, CDCAsyncOper *pasync) :
|
|
ACM(p, pasync),
|
|
wPLType(0) {
|
|
}
|
|
|
|
uint8_t PL2303::Init(uint8_t parent, uint8_t port, bool lowspeed) {
|
|
const uint8_t constBufSize = sizeof (USB_DEVICE_DESCRIPTOR);
|
|
|
|
uint8_t buf[constBufSize];
|
|
USB_DEVICE_DESCRIPTOR * udd = reinterpret_cast<USB_DEVICE_DESCRIPTOR*>(buf);
|
|
uint8_t rcode;
|
|
UsbDevice *p = NULL;
|
|
EpInfo *oldep_ptr = NULL;
|
|
uint8_t num_of_conf; // number of configurations
|
|
#ifdef PL2303_COMPAT
|
|
enum pl2303_type pltype = unknown;
|
|
#endif
|
|
|
|
AddressPool &addrPool = pUsb->GetAddressPool();
|
|
|
|
USBTRACE("PL Init\r\n");
|
|
|
|
if(bAddress)
|
|
return USB_ERROR_CLASS_INSTANCE_ALREADY_IN_USE;
|
|
|
|
// Get pointer to pseudo device with address 0 assigned
|
|
p = addrPool.GetUsbDevicePtr(0);
|
|
|
|
if(!p)
|
|
return USB_ERROR_ADDRESS_NOT_FOUND_IN_POOL;
|
|
|
|
if(!p->epinfo) {
|
|
USBTRACE("epinfo\r\n");
|
|
return USB_ERROR_EPINFO_IS_NULL;
|
|
}
|
|
|
|
// Save old pointer to EP_RECORD of address 0
|
|
oldep_ptr = p->epinfo;
|
|
|
|
// Temporary assign new pointer to epInfo to p->epinfo in order to avoid toggle inconsistence
|
|
p->epinfo = epInfo;
|
|
|
|
p->lowspeed = lowspeed;
|
|
|
|
// Get device descriptor
|
|
rcode = pUsb->getDevDescr(0, 0, sizeof (USB_DEVICE_DESCRIPTOR), (uint8_t*)buf);
|
|
|
|
// Restore p->epinfo
|
|
p->epinfo = oldep_ptr;
|
|
|
|
if(rcode)
|
|
goto FailGetDevDescr;
|
|
|
|
if(udd->idVendor != PL_VID && CHECK_PID(udd->idProduct))
|
|
return USB_DEV_CONFIG_ERROR_DEVICE_NOT_SUPPORTED;
|
|
|
|
/* determine chip variant */
|
|
#ifdef PL2303_COMPAT
|
|
if(udd->bDeviceClass == 0x02 )
|
|
pltype = type_0;
|
|
else if(udd->bMaxPacketSize0 == 0x40 )
|
|
pltype = rev_HX;
|
|
else if(udd->bDeviceClass == 0x00)
|
|
pltype = type_1;
|
|
else if(udd->bDeviceClass == 0xff)
|
|
pltype = type_1;
|
|
#endif
|
|
|
|
// Save type of PL chip
|
|
wPLType = udd->bcdDevice;
|
|
|
|
// 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 = udd->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 = udd->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++) {
|
|
HexDumper<USBReadParser, uint16_t, uint16_t> HexDump;
|
|
ConfigDescParser < 0xFF, 0, 0, CP_MASK_COMPARE_CLASS> confDescrParser(this);
|
|
|
|
rcode = pUsb->getConfDescr(bAddress, 0, i, &HexDump);
|
|
|
|
if(rcode)
|
|
goto FailGetConfDescr;
|
|
|
|
rcode = pUsb->getConfDescr(bAddress, 0, i, &confDescrParser);
|
|
|
|
if(rcode)
|
|
goto FailGetConfDescr;
|
|
|
|
if(bNumEP > 1)
|
|
break;
|
|
} // for
|
|
|
|
if(bNumEP < 2)
|
|
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 FailSetConfDescr;
|
|
|
|
#ifdef PL2303_COMPAT
|
|
/* Shamanic dance - sending Prolific init data as-is */
|
|
vendorRead( 0x84, 0x84, 0, buf );
|
|
vendorWrite( 0x04, 0x04, 0 );
|
|
vendorRead( 0x84, 0x84, 0, buf );
|
|
vendorRead( 0x83, 0x83, 0, buf );
|
|
vendorRead( 0x84, 0x84, 0, buf );
|
|
vendorWrite( 0x04, 0x04, 1 );
|
|
vendorRead( 0x84, 0x84, 0, buf);
|
|
vendorRead( 0x83, 0x83, 0, buf);
|
|
vendorWrite( 0, 0, 1 );
|
|
vendorWrite( 1, 0, 0 );
|
|
if( pltype == rev_HX ) {
|
|
vendorWrite( 2, 0, 0x44 );
|
|
vendorWrite( 0x06, 0x06, 0 ); // From W7 init
|
|
}
|
|
else {
|
|
vendorWrite( 2, 0, 0x24 );
|
|
}
|
|
/* Shamanic dance end */
|
|
#endif
|
|
/* Calling post-init callback */
|
|
rcode = pAsync->OnInit(this);
|
|
|
|
if(rcode)
|
|
goto FailOnInit;
|
|
|
|
USBTRACE("PL configured\r\n");
|
|
|
|
//bPollEnable = true;
|
|
ready = true;
|
|
return 0;
|
|
|
|
FailGetDevDescr:
|
|
#ifdef DEBUG_USB_HOST
|
|
NotifyFailGetDevDescr();
|
|
goto Fail;
|
|
#endif
|
|
|
|
FailSetDevTblEntry:
|
|
#ifdef DEBUG_USB_HOST
|
|
NotifyFailSetDevTblEntry();
|
|
goto Fail;
|
|
#endif
|
|
|
|
FailGetConfDescr:
|
|
#ifdef DEBUG_USB_HOST
|
|
NotifyFailGetConfDescr();
|
|
goto Fail;
|
|
#endif
|
|
|
|
FailSetConfDescr:
|
|
#ifdef DEBUG_USB_HOST
|
|
NotifyFailSetConfDescr();
|
|
goto Fail;
|
|
#endif
|
|
|
|
FailOnInit:
|
|
#ifdef DEBUG_USB_HOST
|
|
USBTRACE("OnInit:");
|
|
#endif
|
|
|
|
#ifdef DEBUG_USB_HOST
|
|
Fail:
|
|
NotifyFail(rcode);
|
|
#endif
|
|
Release();
|
|
return rcode;
|
|
}
|
|
|
|
//uint8_t PL::Poll()
|
|
//{
|
|
// uint8_t rcode = 0;
|
|
//
|
|
// //if (!bPollEnable)
|
|
// // return 0;
|
|
//
|
|
// //if (qNextPollTime <= millis())
|
|
// //{
|
|
// // USB_HOST_SERIAL.println(bAddress, HEX);
|
|
//
|
|
// // qNextPollTime = millis() + 100;
|
|
// //}
|
|
// return rcode;
|
|
//}
|