- while ( counter < 2 )
- {
- //set/reset variables and counters
- memset(ID,0x00,sizeof(ID));
- memset(Parity,0x00,sizeof(Parity));
- rows = 0;
- for ( i = 9; i <= LengthOfBitstream; i++)
- {
- if ( rows < 10 )
- {
- if ((BitStream[i] ^ BitStream[i+1] ^ BitStream[i+2] ^ BitStream[i+3]) == BitStream[i+4])
- {
- sprintf(ID+rows, "%x", (8 * BitStream[i]) + (4 * BitStream[i+1]) + (2 * BitStream[i+2]) + (1 * BitStream[i+3]));
- rows++;
- /* Keep parity info and move four bits ahead*/
- Parity[0] ^= BitStream[i];
- Parity[1] ^= BitStream[i+1];
- Parity[2] ^= BitStream[i+2];
- Parity[3] ^= BitStream[i+3];
- i += 4;
- }
- }
- if ( rows == 10 )
- {
- if ( BitStream[i] == Parity[0] && BitStream[i+1] == Parity[1] &&
- BitStream[i+2] == Parity[2] && BitStream[i+3] == Parity[3] &&
- BitStream[i+4] == 0)
- {
- memcpy(pID,ID,strlen(ID));
- return 1;
- }
+ return TRUE;
+}
+
+// param: idx - start index in demoded data.
+bool setDemodBufferEM(uint32_t *word, size_t idx){
+
+ //test for even parity bits.
+ uint8_t parity[45] = {0};
+ memcpy( parity, DemodBuffer, 45);
+ if (!EMwordparitytest(parity) ){
+ PrintAndLog("DEBUG: Error - EM Parity tests failed");
+ return FALSE;
+ }
+
+ if (!removeParity(DemodBuffer, idx + EM_PREAMBLE_LEN, 9, 0, 44)) {
+ if (g_debugMode) PrintAndLog("DEBUG: Error - EM, failed removing parity");
+ return FALSE;
+ }
+ setDemodBuf(DemodBuffer, 40, 0);
+ *word = bytebits_to_byteLSBF(DemodBuffer, 32);
+ return TRUE;
+}
+
+// FSK, PSK, ASK/MANCHESTER, ASK/BIPHASE, ASK/DIPHASE
+// should cover 90% of known used configs
+// the rest will need to be manually demoded for now...
+bool demodEM4x05resp(uint32_t *word) {
+ size_t idx = 0;
+
+ if (detectASK_MAN() && doPreambleSearch( &idx ))
+ return setDemodBufferEM(word, idx);
+
+ if (detectASK_BI() && doPreambleSearch( &idx ))
+ return setDemodBufferEM(word, idx);
+
+ if (detectFSK() && doPreambleSearch( &idx ))
+ return setDemodBufferEM(word, idx);
+
+ if (detectPSK()) {
+ if (doPreambleSearch( &idx ))
+ return setDemodBufferEM(word, idx);
+
+ psk1TOpsk2(DemodBuffer, DemodBufferLen);
+ if (doPreambleSearch( &idx ))
+ return setDemodBufferEM(word, idx);
+ }
+ return FALSE;
+}
+
+//////////////// 4205 / 4305 commands
+int usage_lf_em4x05_dump(void) {
+ PrintAndLog("Dump EM4x05/EM4x69. Tag must be on antenna. ");
+ PrintAndLog("");
+ PrintAndLog("Usage: lf em 4x05dump [h] <pwd>");
+ PrintAndLog("Options:");
+ PrintAndLog(" h - this help");
+ PrintAndLog(" pwd - password (hex) (optional)");
+ PrintAndLog("samples:");
+ PrintAndLog(" lf em 4x05dump");
+ PrintAndLog(" lf em 4x05dump 11223344");
+ return 0;
+}
+int usage_lf_em4x05_read(void) {
+ PrintAndLog("Read EM4x05/EM4x69. Tag must be on antenna. ");
+ PrintAndLog("");
+ PrintAndLog("Usage: lf em 4x05read [h] <address> <pwd>");
+ PrintAndLog("Options:");
+ PrintAndLog(" h - this help");
+ PrintAndLog(" address - memory address to read. (0-15)");
+ PrintAndLog(" pwd - password (hex) (optional)");
+ PrintAndLog("samples:");
+ PrintAndLog(" lf em 4x05read 1");
+ PrintAndLog(" lf em 4x05read 1 11223344");
+ return 0;
+}
+int usage_lf_em4x05_write(void) {
+ PrintAndLog("Write EM4x05/4x69. Tag must be on antenna. ");
+ PrintAndLog("");
+ PrintAndLog("Usage: lf em 4x05write [h] <address> <data> <pwd>");
+ PrintAndLog("Options:");
+ PrintAndLog(" h - this help");
+ PrintAndLog(" address - memory address to write to. (0-15)");
+ PrintAndLog(" data - data to write (hex)");
+ PrintAndLog(" pwd - password (hex) (optional)");
+ PrintAndLog("samples:");
+ PrintAndLog(" lf em 4x05write 1 deadc0de");
+ PrintAndLog(" lf em 4x05write 1 deadc0de 11223344");
+ return 0;
+}
+
+int CmdEM4x05Dump(const char *Cmd) {
+ uint8_t addr = 0;
+ uint32_t pwd = 0;
+ bool usePwd = false;
+ uint8_t ctmp = param_getchar(Cmd, 0);
+ if ( ctmp == 'H' || ctmp == 'h' ) return usage_lf_em4x05_dump();
+
+ // for now use default input of 1 as invalid (unlikely 1 will be a valid password...)
+ pwd = param_get32ex(Cmd, 0, 1, 16);
+
+ if ( pwd != 1 )
+ usePwd = true;
+
+ int success = 1;
+ PrintAndLog("Addr | data | ascii");
+ PrintAndLog("-----+--------+------");
+ for (; addr < 16; addr++) {
+ if (addr == 2) {
+ if (usePwd) {
+ PrintAndLog(" %02u | %08X", addr, pwd);
+ } else {
+ PrintAndLog(" 02 | cannot read");