/*\r
LUFA Library\r
- Copyright (C) Dean Camera, 2009.\r
+ Copyright (C) Dean Camera, 2010.\r
\r
dean [at] fourwalledcubicle [dot] com\r
www.fourwalledcubicle.com\r
*/\r
\r
/*\r
- Copyright 2009 Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
-\r
- Permission to use, copy, modify, and distribute this software\r
- and its documentation for any purpose and without fee is hereby\r
- granted, provided that the above copyright notice appear in all\r
- copies and that both that the copyright notice and this\r
- permission notice and warranty disclaimer appear in supporting\r
- documentation, and that the name of the author not be used in\r
- advertising or publicity pertaining to distribution of the\r
+ Copyright 2010 Dean Camera (dean [at] fourwalledcubicle [dot] com)\r
+\r
+ Permission to use, copy, modify, distribute, and sell this \r
+ software and its documentation for any purpose is hereby granted\r
+ without fee, provided that the above copyright notice appear in \r
+ all copies and that both that the copyright notice and this\r
+ permission notice and warranty disclaimer appear in supporting \r
+ documentation, and that the name of the author not be used in \r
+ advertising or publicity pertaining to distribution of the \r
software without specific, written prior permission.\r
\r
The author disclaim all warranties with regard to this\r
\r
uint8_t USB_ProcessHIDReport(const uint8_t* ReportData, uint16_t ReportSize, HID_ReportInfo_t* const ParserData)\r
{\r
- HID_StateTable_t StateTable[HID_STATETABLE_STACK_DEPTH];\r
- HID_StateTable_t* CurrStateTable = &StateTable[0];\r
- uint16_t UsageStack[HID_USAGE_STACK_DEPTH];\r
- uint8_t UsageStackSize = 0;\r
- uint16_t BitOffsetIn = 0;\r
- uint16_t BitOffsetOut = 0;\r
-#if defined(HID_ENABLE_FEATURE_PROCESSING)\r
- uint16_t BitOffsetFeature = 0;\r
-#endif\r
- HID_CollectionPath_t* CurrCollectionPath = NULL;\r
+ HID_StateTable_t StateTable[HID_STATETABLE_STACK_DEPTH];\r
+ HID_StateTable_t* CurrStateTable = &StateTable[0];\r
+ HID_CollectionPath_t* CurrCollectionPath = NULL;\r
+ HID_ReportSizeInfo_t* CurrReportIDInfo = &ParserData->ReportIDSizes[0]; \r
+ uint16_t UsageList[HID_USAGE_STACK_DEPTH];\r
+ uint8_t UsageListSize = 0;\r
+ HID_MinMax_t UsageMinMax = {0, 0};\r
\r
- memset((void*)ParserData, 0x00, sizeof(HID_ReportInfo_t));\r
- memset((void*)StateTable, 0x00, sizeof(StateTable));\r
+ memset(ParserData, 0x00, sizeof(HID_ReportInfo_t));\r
+ memset(CurrStateTable, 0x00, sizeof(HID_StateTable_t));\r
+ memset(CurrReportIDInfo, 0x00, sizeof(HID_ReportSizeInfo_t));\r
+\r
+ ParserData->TotalDeviceReports = 1; \r
\r
while (ReportSize)\r
{\r
+ uint8_t HIDReportItem = *ReportData;\r
uint32_t ReportItemData = 0;\r
\r
- switch (*ReportData & DATA_SIZE_MASK)\r
+ ReportData++;\r
+ ReportSize--;\r
+ \r
+ switch (HIDReportItem & DATA_SIZE_MASK)\r
{\r
case DATA_SIZE_4:\r
- ReportItemData = *((uint32_t*)(ReportData + 1));\r
+ ReportItemData = *((uint32_t*)ReportData);\r
+ ReportSize -= 4;\r
+ ReportData += 4;\r
break;\r
case DATA_SIZE_2:\r
- ReportItemData = *((uint16_t*)(ReportData + 1));\r
+ ReportItemData = *((uint16_t*)ReportData);\r
+ ReportSize -= 2;\r
+ ReportData += 2;\r
break;\r
case DATA_SIZE_1:\r
- ReportItemData = *((uint8_t*)(ReportData + 1));\r
+ ReportItemData = *((uint8_t*)ReportData);\r
+ ReportSize -= 1;\r
+ ReportData += 1;\r
break;\r
}\r
\r
- switch (*ReportData & (TYPE_MASK | TAG_MASK))\r
+ switch (HIDReportItem & (TYPE_MASK | TAG_MASK))\r
{\r
case (TYPE_GLOBAL | TAG_GLOBAL_PUSH):\r
- if (CurrStateTable == &StateTable[HID_STATETABLE_STACK_DEPTH])\r
+ if (CurrStateTable == &StateTable[HID_STATETABLE_STACK_DEPTH - 1])\r
return HID_PARSE_HIDStackOverflow;\r
\r
- memcpy((CurrStateTable - 1),\r
+ memcpy((CurrStateTable + 1),\r
CurrStateTable,\r
sizeof(HID_ReportItem_t));\r
\r
break;\r
case (TYPE_GLOBAL | TAG_GLOBAL_REPORTID):\r
CurrStateTable->ReportID = ReportItemData;\r
+\r
+ if (ParserData->UsingReportIDs)\r
+ {\r
+ CurrReportIDInfo = NULL;\r
+\r
+ for (uint8_t i = 0; i < ParserData->TotalDeviceReports; i++)\r
+ {\r
+ if (ParserData->ReportIDSizes[i].ReportID == CurrStateTable->ReportID)\r
+ {\r
+ CurrReportIDInfo = &ParserData->ReportIDSizes[i];\r
+ break;\r
+ }\r
+ }\r
+ \r
+ if (CurrReportIDInfo == NULL)\r
+ {\r
+ if (ParserData->TotalDeviceReports == HID_MAX_REPORT_IDS)\r
+ return HID_PARSE_InsufficientReportIDItems;\r
+ \r
+ CurrReportIDInfo = &ParserData->ReportIDSizes[ParserData->TotalDeviceReports++];\r
+ memset(CurrReportIDInfo, 0x00, sizeof(HID_ReportSizeInfo_t));\r
+ }\r
+ }\r
+\r
+ ParserData->UsingReportIDs = true; \r
+\r
+ CurrReportIDInfo->ReportID = CurrStateTable->ReportID;\r
break;\r
case (TYPE_LOCAL | TAG_LOCAL_USAGE):\r
- if (UsageStackSize == HID_USAGE_STACK_DEPTH)\r
- return HID_PARSE_UsageStackOverflow;\r
+ if (UsageListSize == HID_USAGE_STACK_DEPTH)\r
+ return HID_PARSE_UsageListOverflow;\r
\r
- UsageStack[UsageStackSize++] = ReportItemData;\r
+ UsageList[UsageListSize++] = ReportItemData;\r
break;\r
case (TYPE_LOCAL | TAG_LOCAL_USAGEMIN):\r
- CurrStateTable->Attributes.Usage.MinMax.Minimum = ReportItemData;\r
+ UsageMinMax.Minimum = ReportItemData;\r
break;\r
case (TYPE_LOCAL | TAG_LOCAL_USAGEMAX):\r
- CurrStateTable->Attributes.Usage.MinMax.Maximum = ReportItemData;\r
+ UsageMinMax.Maximum = ReportItemData;\r
break;\r
case (TYPE_MAIN | TAG_MAIN_COLLECTION):\r
if (CurrCollectionPath == NULL)\r
\r
CurrCollectionPath = &ParserData->CollectionPaths[1];\r
\r
- while (CurrCollectionPath->Parent != NULL);\r
+ while (CurrCollectionPath->Parent != NULL)\r
{\r
- if (CurrCollectionPath == &ParserData->CollectionPaths[HID_MAX_COLLECTIONS])\r
+ if (CurrCollectionPath == &ParserData->CollectionPaths[HID_MAX_COLLECTIONS - 1])\r
return HID_PARSE_InsufficientCollectionPaths;\r
\r
CurrCollectionPath++;\r
CurrCollectionPath->Type = ReportItemData;\r
CurrCollectionPath->Usage.Page = CurrStateTable->Attributes.Usage.Page;\r
\r
- if (UsageStackSize)\r
+ if (UsageListSize)\r
{\r
- CurrCollectionPath->Usage.Usage = UsageStack[0];\r
+ CurrCollectionPath->Usage.Usage = UsageList[0];\r
\r
- for (uint8_t i = 0; i < UsageStackSize; i++)\r
- UsageStack[i] = UsageStack[i + 1];\r
- \r
- UsageStackSize--;\r
+ for (uint8_t i = 0; i < UsageListSize; i++)\r
+ UsageList[i] = UsageList[i + 1];\r
+ \r
+ UsageListSize--;\r
}\r
- else\r
+ else if (UsageMinMax.Minimum <= UsageMinMax.Maximum)\r
{\r
- CurrCollectionPath->Usage.Usage = 0;\r
+ CurrCollectionPath->Usage.Usage = UsageMinMax.Minimum++;\r
}\r
\r
break;\r
return HID_PARSE_UnexpectedEndCollection;\r
\r
CurrCollectionPath = CurrCollectionPath->Parent;\r
-\r
break;\r
case (TYPE_MAIN | TAG_MAIN_INPUT):\r
case (TYPE_MAIN | TAG_MAIN_OUTPUT):\r
-#if defined(HID_ENABLE_FEATURE_PROCESSING)\r
case (TYPE_MAIN | TAG_MAIN_FEATURE):\r
-#endif\r
for (uint8_t ReportItemNum = 0; ReportItemNum < CurrStateTable->ReportCount; ReportItemNum++)\r
{\r
- HID_ReportItem_t* CurrReportItem = &ParserData->ReportItems[ParserData->TotalReportItems];\r
- \r
- if (ParserData->TotalReportItems == HID_MAX_REPORTITEMS)\r
- return HID_PARSE_InsufficientReportItems;\r
+ HID_ReportItem_t NewReportItem;\r
\r
- memcpy(&CurrReportItem->Attributes,\r
+ memcpy(&NewReportItem.Attributes,\r
&CurrStateTable->Attributes,\r
sizeof(HID_ReportItem_Attributes_t));\r
\r
- CurrReportItem->ItemFlags = ReportItemData;\r
- CurrReportItem->CollectionPath = CurrCollectionPath;\r
- CurrReportItem->ReportID = CurrStateTable->ReportID;\r
+ NewReportItem.ItemFlags = ReportItemData;\r
+ NewReportItem.CollectionPath = CurrCollectionPath;\r
+ NewReportItem.ReportID = CurrStateTable->ReportID;\r
\r
- if (UsageStackSize)\r
+ if (UsageListSize)\r
{\r
- CurrReportItem->Attributes.Usage.Usage = UsageStack[0];\r
+ NewReportItem.Attributes.Usage.Usage = UsageList[0];\r
\r
- for (uint8_t i = 0; i < UsageStackSize; i++)\r
- UsageStack[i] = UsageStack[i + 1];\r
+ for (uint8_t i = 0; i < UsageListSize; i++)\r
+ UsageList[i] = UsageList[i + 1];\r
\r
- UsageStackSize--;\r
+ UsageListSize--;\r
}\r
- else\r
+ else if (UsageMinMax.Minimum <= UsageMinMax.Maximum)\r
{\r
- CurrReportItem->Attributes.Usage.Usage = 0;\r
+ NewReportItem.Attributes.Usage.Usage = UsageMinMax.Minimum++;\r
}\r
- \r
- switch (*ReportData & TAG_MASK)\r
- {\r
- case TAG_MAIN_INPUT:\r
- CurrReportItem->ItemType = REPORT_ITEM_TYPE_In;\r
- CurrReportItem->BitOffset = BitOffsetIn;\r
- \r
- BitOffsetIn += CurrStateTable->Attributes.BitSize;\r
- \r
- break;\r
- case TAG_MAIN_OUTPUT:\r
- CurrReportItem->ItemType = REPORT_ITEM_TYPE_Out;\r
- CurrReportItem->BitOffset = BitOffsetOut;\r
- \r
- BitOffsetOut += CurrStateTable->Attributes.BitSize;\r
- \r
- break;\r
-#if defined(HID_ENABLE_FEATURE_PROCESSING)\r
- case TAG_MAIN_FEATURE:\r
- CurrReportItem->ItemType = REPORT_ITEM_TYPE_Feature; \r
- CurrReportItem->BitOffset = BitOffsetFeature;\r
- \r
- BitOffsetFeature += CurrStateTable->Attributes.BitSize; \r
+ \r
+ uint8_t ItemTag = (HIDReportItem & TAG_MASK);\r
\r
- break;\r
-#endif\r
- }\r
+ if (ItemTag == TAG_MAIN_INPUT)\r
+ NewReportItem.ItemType = REPORT_ITEM_TYPE_In;\r
+ else if (ItemTag == TAG_MAIN_OUTPUT)\r
+ NewReportItem.ItemType = REPORT_ITEM_TYPE_Out;\r
+ else\r
+ NewReportItem.ItemType = REPORT_ITEM_TYPE_Feature;\r
\r
-#if !defined(HID_INCLUDE_CONSTANT_DATA_ITEMS)\r
- if (!(ReportItemData & IOF_CONSTANT))\r
- ParserData->TotalReportItems++;\r
-#else\r
- ParserData->TotalReportItems++;\r
-#endif\r
+ NewReportItem.BitOffset = CurrReportIDInfo->ReportSizeBits[NewReportItem.ItemType];\r
+\r
+ CurrReportIDInfo->ReportSizeBits[NewReportItem.ItemType] += CurrStateTable->Attributes.BitSize;\r
+\r
+ if (ParserData->LargestReportSizeBits < NewReportItem.BitOffset)\r
+ ParserData->LargestReportSizeBits = NewReportItem.BitOffset;\r
+ \r
+ if (!(ReportItemData & IOF_CONSTANT) && CALLBACK_HIDParser_FilterHIDReportItem(&NewReportItem))\r
+ { \r
+ if (ParserData->TotalReportItems == HID_MAX_REPORTITEMS)\r
+ return HID_PARSE_InsufficientReportItems;\r
+ \r
+ memcpy(&ParserData->ReportItems[ParserData->TotalReportItems],\r
+ &NewReportItem, sizeof(HID_ReportItem_t));\r
+ \r
+ ParserData->TotalReportItems++;\r
+ }\r
}\r
\r
- UsageStackSize = 0;\r
- \r
break;\r
}\r
\r
- if ((*ReportData & TYPE_MASK) == TYPE_MAIN)\r
+ if ((HIDReportItem & TYPE_MASK) == TYPE_MAIN)\r
{\r
- CurrStateTable->Attributes.Usage.MinMax.Minimum = 0;\r
- CurrStateTable->Attributes.Usage.MinMax.Maximum = 0;\r
- UsageStackSize = 0;\r
- }\r
- \r
- switch (*ReportData & DATA_SIZE_MASK)\r
- {\r
- case DATA_SIZE_4:\r
- ReportSize -= 5;\r
- ReportData += 5;\r
- break;\r
- case DATA_SIZE_2:\r
- ReportSize -= 3;\r
- ReportData += 3;\r
- break;\r
- case DATA_SIZE_1:\r
- ReportSize -= 2;\r
- ReportData += 2;\r
- break;\r
- case DATA_SIZE_0:\r
- ReportSize -= 1;\r
- ReportData += 1;\r
- break;\r
+ UsageMinMax.Minimum = 0;\r
+ UsageMinMax.Maximum = 0;\r
+ UsageListSize = 0;\r
}\r
}\r
\r
+ if (!(ParserData->TotalReportItems))\r
+ return HID_PARSE_NoUnfilteredReportItems;\r
+ \r
return HID_PARSE_Successful;\r
}\r
\r
uint16_t CurrentBit = ReportItem->BitOffset;\r
uint32_t BitMask = (1 << 0);\r
\r
+ ReportItem->PreviousValue = ReportItem->Value;\r
ReportItem->Value = 0;\r
\r
if (ReportItem->ReportID)\r
return true;\r
}\r
\r
-void USB_SetHIDReportItemInfo(uint8_t* ReportData, const HID_ReportItem_t* ReportItem)\r
+void USB_SetHIDReportItemInfo(uint8_t* ReportData, HID_ReportItem_t* const ReportItem)\r
{\r
uint16_t DataBitsRem = ReportItem->Attributes.BitSize;\r
uint16_t CurrentBit = ReportItem->BitOffset;\r
ReportData++;\r
}\r
\r
+ ReportItem->PreviousValue = ReportItem->Value;\r
+\r
while (DataBitsRem--)\r
{\r
if (ReportItem->Value & (1 << (CurrentBit % 8)))\r
}\r
}\r
\r
+uint16_t USB_GetHIDReportSize(HID_ReportInfo_t* const ParserData, const uint8_t ReportID, const uint8_t ReportType)\r
+{\r
+ for (uint8_t i = 0; i < HID_MAX_REPORT_IDS; i++)\r
+ {\r
+ if (ParserData->ReportIDSizes[i].ReportID == ReportID)\r
+ return ParserData->ReportIDSizes[i].ReportSizeBits[ReportType];\r
+ }\r
+\r
+ return 0;\r
+}\r
+\r
#endif\r
projects / pub / USBasp.git / blobdiff