-void annotateLegic(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize){
-
- if ( cmdsize > 1) {
- switch(cmd[0]) {
- case LEGIC_READ :snprintf(exp, size, "READ Byte(%d)", cmd[1]);break;
- case LEGIC_WRITE :snprintf(exp, size, "WRITE Byte(%d)", cmd[1]);break;
- default :snprintf(exp, size, "?"); break;
- }
- } else {
- switch(cmd[0]) {
- case LEGIC_HSK :snprintf(exp, size, "END Handshake");break;
- default :snprintf(exp, size, "?"); break;
- }
+void annotateLegic(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize){
+ uint8_t bitsend = cmd[0];
+ switch (bitsend){
+ case 7:
+ snprintf(exp, size, "IV 0x%02X", cmd[1]);
+ break;
+ case 6: {
+ switch ( cmd[1] ) {
+ case LEGIC_MIM_22: snprintf(exp, size, "MIM22"); break;
+ case LEGIC_MIM_256: snprintf(exp, size, "MIM256"); break;
+ case LEGIC_MIM_1024: snprintf(exp, size, "MIM1024"); break;
+ case LEGIC_ACK_22: snprintf(exp, size, "ACK 22"); break;
+ case LEGIC_ACK_256: snprintf(exp, size, "ACK 256/1024"); break;
+ }
+ break;
+ }
+ case 9:
+ case 11: {
+ uint8_t cmdBit = (cmd[1] & 1);
+ uint16_t address = (cmd[2] << 7) | cmd[1] >> 1;
+
+ if (cmdBit == LEGIC_READ)
+ snprintf(exp, size, "READ Byte(%d)", address);
+
+ if (cmdBit == LEGIC_WRITE )
+ snprintf(exp, size, "WRITE Byte(%d)", address);
+ break;
+ }
+ case 12:
+ default:
+ break;