| 0,0 → 1,86 |
|---|
| #include "pseventparser.h" |
| |
| void PSEventParser::Parse(const uint16_t len, const uint8_t *pbuf, const uint32_t &offset) |
| { |
| uint16_t cntdn = (uint16_t)len; |
| uint8_t *p = (uint8_t*)pbuf; |
| |
| switch (nStage) |
| { |
| case 0: |
| p += 12; |
| cntdn -= 12; |
| |
| if (!cntdn) |
| return; |
| nStage ++; |
| |
| case 1: |
| //Notify(PSTR("\r\nEvent Block Size:\t")); |
| theBuffer.valueSize = 4; |
| valueParser.Initialize(&theBuffer); |
| nStage ++; |
| case 2: |
| if (!valueParser.Parse(&p, &cntdn)) |
| return; |
| |
| //PrintHex<uint32_t>(*((uint32_t*)theBuffer.pValue)); |
| nStage ++; |
| case 3: |
| //Notify(PSTR("\r\nNumber of Fields:\t")); |
| theBuffer.valueSize = 2; |
| valueParser.Initialize(&theBuffer); |
| nStage ++; |
| case 4: |
| if (!valueParser.Parse(&p, &cntdn)) |
| return; |
| |
| //PrintHex<uint16_t>(*((uint16_t*)theBuffer.pValue)); |
| nStage ++; |
| case 5: |
| //Notify(PSTR("\r\nEvent Code:\t")); |
| theBuffer.valueSize = 2; |
| valueParser.Initialize(&theBuffer); |
| nStage ++; |
| case 6: |
| if (!valueParser.Parse(&p, &cntdn)) |
| return; |
| |
| eventCode = *((uint16_t*)theBuffer.pValue); |
| //PrintHex<uint16_t>(*((uint16_t*)theBuffer.pValue)); |
| nStage ++; |
| case 7: |
| //Notify(PSTR("\r\nTransaction ID:\t")); |
| theBuffer.valueSize = 4; |
| valueParser.Initialize(&theBuffer); |
| nStage ++; |
| case 8: |
| if (!valueParser.Parse(&p, &cntdn)) |
| return; |
| |
| //PrintHex<uint32_t>(*((uint32_t*)theBuffer.pValue)); |
| nStage ++; |
| case 9: |
| if (eventCode == PTP_EC_ObjectAdded) |
| Notify(PSTR("\r\nObject Added:\t\t")); |
| |
| theBuffer.valueSize = 4; |
| valueParser.Initialize(&theBuffer); |
| nStage ++; |
| case 10: |
| if (eventCode == PTP_EC_ObjectAdded) |
| { |
| if (!valueParser.Parse(&p, &cntdn)) |
| return; |
| |
| objHandle = *((uint32_t*)theBuffer.pValue); |
| PrintHex<uint32_t>(*((uint32_t*)theBuffer.pValue)); |
| Notify(PSTR("\r\n")); |
| } |
| if (eventCode == PTP_EC_CaptureComplete) |
| Notify(PSTR("\r\nCapture complete.\r\n")); |
| nStage ++; |
| case 11: |
| nStage = 0; |
| } |
| } |