修正 status 定义,绕过 felica数据验证逻辑,感谢 Bottersnike 的帮助。
This commit is contained in:
parent
4c0b234bce
commit
8877d1386d
@ -74,23 +74,18 @@ enum {
|
|||||||
CMD_MIFARE_KEY_SET_A = 0x50,
|
CMD_MIFARE_KEY_SET_A = 0x50,
|
||||||
CMD_MIFARE_AUTHORIZE_A = 0x51,
|
CMD_MIFARE_AUTHORIZE_A = 0x51,
|
||||||
CMD_MIFARE_READ = 0x52,
|
CMD_MIFARE_READ = 0x52,
|
||||||
CMD_MIFARE_WRITE = 0x53,
|
// CMD_MIFARE_WRITE = 0x53,
|
||||||
CMD_MIFARE_KEY_SET_B = 0x54,
|
CMD_MIFARE_KEY_SET_B = 0x54,
|
||||||
CMD_MIFARE_AUTHORIZE_B = 0x55,
|
CMD_MIFARE_AUTHORIZE_B = 0x55,
|
||||||
// Boot,update
|
// Boot,update
|
||||||
CMD_TO_UPDATER_MODE = 0x60,
|
// CMD_TO_UPDATER_MODE = 0x60,
|
||||||
CMD_SEND_HEX_DATA = 0x61,
|
// CMD_SEND_HEX_DATA = 0x61,
|
||||||
CMD_TO_NORMAL_MODE = 0x62,
|
CMD_TO_NORMAL_MODE = 0x62,
|
||||||
CMD_SEND_BINDATA_INIT = 0x63,
|
// CMD_SEND_BINDATA_INIT = 0x63,
|
||||||
CMD_SEND_BINDATA_EXEC = 0x64,
|
// CMD_SEND_BINDATA_EXEC = 0x64,
|
||||||
// FeliCa
|
// FeliCa
|
||||||
CMD_FELICA_PUSH = 0x70,
|
// CMD_FELICA_PUSH = 0x70,
|
||||||
CMD_FELICA_THROUGH = 0x71,
|
CMD_FELICA_THROUGH = 0x71,
|
||||||
CMD_FELICA_THROUGH_POLL = 0x00,
|
|
||||||
CMD_FELICA_THROUGH_READ = 0x06,
|
|
||||||
CMD_FELICA_THROUGH_WRITE = 0x08,
|
|
||||||
CMD_FELICA_THROUGH_GET_SYSTEM_CODE = 0x0C,
|
|
||||||
CMD_FELICA_THROUGH_NDA_A4 = 0xA4,
|
|
||||||
// LED board
|
// LED board
|
||||||
CMD_EXT_BOARD_LED = 0x80,
|
CMD_EXT_BOARD_LED = 0x80,
|
||||||
CMD_EXT_BOARD_LED_RGB = 0x81,
|
CMD_EXT_BOARD_LED_RGB = 0x81,
|
||||||
@ -102,14 +97,27 @@ enum {
|
|||||||
CMD_EXT_TO_NORMAL_MODE = 0xf5,
|
CMD_EXT_TO_NORMAL_MODE = 0xf5,
|
||||||
};
|
};
|
||||||
|
|
||||||
enum { // 未确认效果
|
enum {
|
||||||
ERROR_NONE = 0,
|
FelicaPolling = 0x00,
|
||||||
ERROR_NFCRW_INIT_ERROR = 1,
|
FelicaReqResponce = 0x04,
|
||||||
ERROR_NFCRW_FIRMWARE_UP_TO_DATE = 3,
|
FelicaReadWithoutEncryptData = 0x06,
|
||||||
ERROR_NFCRW_ACCESS_ERROR = 4,
|
FelicaWriteWithoutEncryptData = 0x08,
|
||||||
ERROR_CARD_DETECT_TIMEOUT = 5,
|
FelicaReqSysCode = 0x0C,
|
||||||
ERROR_CARD_DETECT_ERROR = 32,
|
FelicaActive2 = 0xA4,
|
||||||
ERROR_FELICA_ERROR = 33,
|
};
|
||||||
|
|
||||||
|
enum {
|
||||||
|
STATUS_OK = 0x00,
|
||||||
|
STATUS_CARD_ERROR = 0x01,
|
||||||
|
STATUS_NOT_ACCEPT = 0x02,
|
||||||
|
STATUS_INVALID_COMMAND = 0x03,
|
||||||
|
STATUS_INVALID_DATA = 0x04,
|
||||||
|
STATUS_SUM_ERROR = 0x05,
|
||||||
|
STATUS_INTERNAL_ERROR = 0x06,
|
||||||
|
STATUS_INVALID_FIRM_DATA = 0x07,
|
||||||
|
STATUS_FIRM_UPDATE_SUCCESS = 0x08,
|
||||||
|
STATUS_COMP_DUMMY_2ND = 0x10,
|
||||||
|
STATUS_COMP_DUMMY_3RD = 0x20,
|
||||||
};
|
};
|
||||||
|
|
||||||
typedef union {
|
typedef union {
|
||||||
@ -225,8 +233,8 @@ uint8_t packet_read() {
|
|||||||
escape = false;
|
escape = false;
|
||||||
}
|
}
|
||||||
req.bytes[++len] = r;
|
req.bytes[++len] = r;
|
||||||
if (len == req.frame_len && checksum == r) {
|
if (len == req.frame_len) {
|
||||||
return req.cmd;
|
return checksum == r ? req.cmd : STATUS_SUM_ERROR;
|
||||||
}
|
}
|
||||||
checksum += r;
|
checksum += r;
|
||||||
}
|
}
|
||||||
@ -263,16 +271,16 @@ void res_init(uint8_t payload_len = 0) {
|
|||||||
res.addr = req.addr;
|
res.addr = req.addr;
|
||||||
res.seq_no = req.seq_no;
|
res.seq_no = req.seq_no;
|
||||||
res.cmd = req.cmd;
|
res.cmd = req.cmd;
|
||||||
res.status = ERROR_NONE;
|
res.status = STATUS_OK;
|
||||||
res.payload_len = payload_len;
|
res.payload_len = payload_len;
|
||||||
}
|
}
|
||||||
|
|
||||||
void sys_to_normal_mode() {
|
void sys_to_normal_mode() {
|
||||||
res_init();
|
res_init();
|
||||||
if (nfc.getFirmwareVersion()) {
|
if (nfc.getFirmwareVersion()) {
|
||||||
res.status = ERROR_NFCRW_FIRMWARE_UP_TO_DATE;
|
res.status = STATUS_INVALID_COMMAND;
|
||||||
} else {
|
} else {
|
||||||
res.status = ERROR_NFCRW_INIT_ERROR;
|
res.status = STATUS_INTERNAL_ERROR;
|
||||||
FastLED.showColor(0xFF0000);
|
FastLED.showColor(0xFF0000);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -292,7 +300,6 @@ void sys_get_led_info() {
|
|||||||
memcpy(res.version, led_info, res.payload_len);
|
memcpy(res.version, led_info, res.payload_len);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void nfc_start_polling() {
|
void nfc_start_polling() {
|
||||||
res_init();
|
res_init();
|
||||||
nfc.setRFField(0x00, 0x01);
|
nfc.setRFField(0x00, 0x01);
|
||||||
@ -318,21 +325,20 @@ void nfc_card_detect() {
|
|||||||
} else {
|
} else {
|
||||||
res_init(1);
|
res_init(1);
|
||||||
res.count = 0;
|
res.count = 0;
|
||||||
res.status = ERROR_NONE;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void nfc_mifare_authorize_a() {
|
void nfc_mifare_authorize_a() {
|
||||||
res_init();
|
res_init();
|
||||||
if (!nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 0, KeyA)) {
|
if (!nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 0, KeyA)) {
|
||||||
res.status = ERROR_NFCRW_ACCESS_ERROR;
|
res.status = STATUS_CARD_ERROR;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void nfc_mifare_authorize_b() {
|
void nfc_mifare_authorize_b() {
|
||||||
res_init();
|
res_init();
|
||||||
if (!nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 1, KeyB)) {
|
if (!nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 1, KeyB)) {
|
||||||
res.status = ERROR_NFCRW_ACCESS_ERROR;
|
res.status = STATUS_CARD_ERROR;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -340,7 +346,7 @@ void nfc_mifare_read() {
|
|||||||
res_init(0x10);
|
res_init(0x10);
|
||||||
if (!nfc.mifareclassic_ReadDataBlock(req.block_no, res.block)) {
|
if (!nfc.mifareclassic_ReadDataBlock(req.block_no, res.block)) {
|
||||||
res_init();
|
res_init();
|
||||||
res.status = ERROR_CARD_DETECT_TIMEOUT;
|
res.status = STATUS_CARD_ERROR;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -350,20 +356,20 @@ void nfc_felica_through() {
|
|||||||
SystemCode = SystemCode >> 8 | SystemCode << 8;
|
SystemCode = SystemCode >> 8 | SystemCode << 8;
|
||||||
} else {
|
} else {
|
||||||
res_init();
|
res_init();
|
||||||
res.status = ERROR_FELICA_ERROR;
|
res.status = STATUS_CARD_ERROR;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
uint8_t code = req.encap_code;
|
uint8_t code = req.encap_code;
|
||||||
res.encap_code = code + 1;
|
res.encap_code = code + 1;
|
||||||
switch (code) {
|
switch (code) {
|
||||||
case CMD_FELICA_THROUGH_POLL:
|
case FelicaPolling:
|
||||||
{
|
{
|
||||||
res_init(0x14);
|
res_init(0x14);
|
||||||
res.poll_systemCode[0] = SystemCode;
|
res.poll_systemCode[0] = SystemCode;
|
||||||
res.poll_systemCode[1] = SystemCode >> 8;
|
res.poll_systemCode[1] = SystemCode >> 8;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case CMD_FELICA_THROUGH_GET_SYSTEM_CODE:
|
case FelicaReqSysCode:
|
||||||
{
|
{
|
||||||
res_init(0x0D);
|
res_init(0x0D);
|
||||||
res.felica_payload[0] = 0x01;
|
res.felica_payload[0] = 0x01;
|
||||||
@ -371,13 +377,13 @@ void nfc_felica_through() {
|
|||||||
res.felica_payload[2] = SystemCode >> 8;
|
res.felica_payload[2] = SystemCode >> 8;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case CMD_FELICA_THROUGH_NDA_A4:
|
case FelicaActive2:
|
||||||
{
|
{
|
||||||
res_init(0x0B);
|
res_init(0x0B);
|
||||||
res.felica_payload[0] = 0x00;
|
res.felica_payload[0] = 0x00;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case CMD_FELICA_THROUGH_READ:
|
case FelicaReadWithoutEncryptData:
|
||||||
{
|
{
|
||||||
uint16_t serviceCodeList[1] = { (uint16_t)(req.serviceCodeList[1] << 8 | req.serviceCodeList[0]) };
|
uint16_t serviceCodeList[1] = { (uint16_t)(req.serviceCodeList[1] << 8 | req.serviceCodeList[0]) };
|
||||||
for (uint8_t i = 0; i < req.numBlock; i++) {
|
for (uint8_t i = 0; i < req.numBlock; i++) {
|
||||||
@ -392,7 +398,7 @@ void nfc_felica_through() {
|
|||||||
res_init(0x0D + req.numBlock * 16);
|
res_init(0x0D + req.numBlock * 16);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
case CMD_FELICA_THROUGH_WRITE:
|
case FelicaWriteWithoutEncryptData:
|
||||||
{
|
{
|
||||||
res_init(0x0C); // WriteWithoutEncryption,ignore
|
res_init(0x0C); // WriteWithoutEncryption,ignore
|
||||||
res.RW_status[0] = 0;
|
res.RW_status[0] = 0;
|
||||||
@ -401,7 +407,7 @@ void nfc_felica_through() {
|
|||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
res_init();
|
res_init();
|
||||||
res.status = ERROR_FELICA_ERROR;
|
res.status = STATUS_INVALID_COMMAND;
|
||||||
}
|
}
|
||||||
res.encap_len = res.payload_len;
|
res.encap_len = res.payload_len;
|
||||||
}
|
}
|
||||||
|
@ -71,9 +71,9 @@ void loop() {
|
|||||||
break;
|
break;
|
||||||
|
|
||||||
// FeliCa
|
// FeliCa
|
||||||
case CMD_FELICA_THROUGH:
|
// case CMD_FELICA_THROUGH:
|
||||||
nfc_felica_through();
|
// nfc_felica_through();
|
||||||
break;
|
// break;
|
||||||
|
|
||||||
// LED
|
// LED
|
||||||
case CMD_EXT_BOARD_LED_RGB:
|
case CMD_EXT_BOARD_LED_RGB:
|
||||||
@ -87,8 +87,20 @@ void loop() {
|
|||||||
case CMD_EXT_BOARD_LED_RGB_UNKNOWN:
|
case CMD_EXT_BOARD_LED_RGB_UNKNOWN:
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case CMD_CARD_SELECT:
|
||||||
|
case CMD_CARD_HALT:
|
||||||
|
case CMD_EXT_TO_NORMAL_MODE:
|
||||||
|
res_init();
|
||||||
|
break;
|
||||||
|
|
||||||
|
case STATUS_SUM_ERROR:
|
||||||
|
res_init();
|
||||||
|
res.status = STATUS_SUM_ERROR;
|
||||||
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
res_init();
|
res_init();
|
||||||
|
res.status = STATUS_INVALID_COMMAND;
|
||||||
}
|
}
|
||||||
packet_write();
|
packet_write();
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user