324 lines
8.6 KiB
C
324 lines
8.6 KiB
C
|
#include "FastLED.h"
|
|||
|
|
#define NUM_LEDS 1
|
|||
|
|
CRGB leds[NUM_LEDS];
|
|||
|
|
|
|||
|
|
#define SerialDevice Serial
|
|||
|
|
#define LED_PIN 5
|
|||
|
|
|
|||
|
|
|
|||
|
|
#if defined(PN532_SPI_SS)
|
|||
|
|
#pragma message "使用 SPI 连接 PN532"
|
|||
|
|
#include <SPI.h>
|
|||
|
|
#include <PN532_SPI.h>
|
|||
|
|
PN532_SPI pn532(SPI, PN532_SPI_SS);
|
|||
|
|
#else
|
|||
|
|
#include <Wire.h>
|
|||
|
|
#include <PN532_I2C.h>
|
|||
|
|
PN532_I2C pn532(Wire);
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
#include "PN532.h"
|
|||
|
|
PN532 nfc(pn532);
|
|||
|
|
|
|||
|
|
uint8_t AimeKey[6], BanaKey[6];
|
|||
|
|
|
|||
|
|
enum {
|
|||
|
|
SG_NFC_CMD_GET_FW_VERSION = 0x30,
|
|||
|
|
SG_NFC_CMD_GET_HW_VERSION = 0x32,
|
|||
|
|
SG_NFC_CMD_RADIO_ON = 0x40,
|
|||
|
|
SG_NFC_CMD_RADIO_OFF = 0x41,
|
|||
|
|
SG_NFC_CMD_POLL = 0x42,
|
|||
|
|
SG_NFC_CMD_MIFARE_SELECT_TAG = 0x43,
|
|||
|
|
SG_NFC_CMD_MIFARE_SET_KEY_BANA = 0x50,
|
|||
|
|
SG_NFC_CMD_BANA_AUTHENTICATE = 0x51,
|
|||
|
|
SG_NFC_CMD_MIFARE_READ_BLOCK = 0x52,
|
|||
|
|
SG_NFC_CMD_MIFARE_SET_KEY_AIME = 0x54,
|
|||
|
|
SG_NFC_CMD_AIME_AUTHENTICATE = 0x55,
|
|||
|
|
SG_NFC_CMD_TO_UPDATER_MODE = 0x60,
|
|||
|
|
SG_NFC_CMD_SEND_HEX_DATA = 0x61,
|
|||
|
|
SG_NFC_CMD_RESET = 0x62,
|
|||
|
|
SG_NFC_CMD_FELICA_ENCAP = 0x71,
|
|||
|
|
SG_RGB_CMD_SET_COLOR = 0x81,
|
|||
|
|
SG_RGB_CMD_GET_INFO = 0xF0,
|
|||
|
|
SG_RGB_CMD_RESET = 0xF5,
|
|||
|
|
|
|||
|
|
//FELICA_ENCAP
|
|||
|
|
FELICA_CMD_POLL = 0x00,
|
|||
|
|
FELICA_CMD_NDA_06 = 0x06,
|
|||
|
|
FELICA_CMD_NDA_08 = 0x08,
|
|||
|
|
FELICA_CMD_GET_SYSTEM_CODE = 0x0C,
|
|||
|
|
FELICA_CMD_NDA_A4 = 0xA4,
|
|||
|
|
};
|
|||
|
|
|
|||
|
|
typedef union packet_req {
|
|||
|
|
uint8_t bytes[128];
|
|||
|
|
struct {
|
|||
|
|
uint8_t frame_len;
|
|||
|
|
uint8_t addr;
|
|||
|
|
uint8_t seq_no;
|
|||
|
|
uint8_t cmd;
|
|||
|
|
uint8_t payload_len;
|
|||
|
|
union {
|
|||
|
|
uint8_t key[6]; //sg_nfc_req_mifare_set_key(bana or aime)
|
|||
|
|
uint8_t color_payload[3];//sg_led_req_set_color
|
|||
|
|
struct { //sg_nfc_cmd_mifare_select_tag,sg_nfc_cmd_mifare_authenticate,sg_nfc_cmd_mifare_read_block
|
|||
|
|
uint8_t uid[4];
|
|||
|
|
uint8_t block_no;
|
|||
|
|
};
|
|||
|
|
struct { //sg_nfc_req_felica_encap
|
|||
|
|
uint8_t encap_IDm[8];
|
|||
|
|
uint8_t encap_len;
|
|||
|
|
uint8_t encap_code;
|
|||
|
|
union {
|
|||
|
|
struct { //FELICA_CMD_POLL，猜测
|
|||
|
|
uint8_t poll_systemCode[2];
|
|||
|
|
uint8_t poll_requestCode;
|
|||
|
|
uint8_t poll_timeout;
|
|||
|
|
};
|
|||
|
|
struct { //NDA_06,NDA_08,NDA_A4
|
|||
|
|
uint8_t RW_IDm[8];
|
|||
|
|
uint8_t numService;//and NDA_A4 unknown byte
|
|||
|
|
uint8_t serviceCodeList[2];
|
|||
|
|
uint8_t numBlock;
|
|||
|
|
uint8_t blockList[1][2];//长度可变
|
|||
|
|
uint8_t blockData[16];//WriteWithoutEncryption,ignore
|
|||
|
|
};
|
|||
|
|
uint8_t felica_payload[1];
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
} packet_req_t;
|
|||
|
|
|
|||
|
|
typedef union packet_res {
|
|||
|
|
uint8_t bytes[128];
|
|||
|
|
struct {
|
|||
|
|
uint8_t frame_len;
|
|||
|
|
uint8_t addr;
|
|||
|
|
uint8_t seq_no;
|
|||
|
|
uint8_t cmd;
|
|||
|
|
uint8_t status;
|
|||
|
|
uint8_t payload_len;
|
|||
|
|
union {
|
|||
|
|
char version[23]; //sg_nfc_res_get_fw_version,sg_nfc_res_get_hw_version
|
|||
|
|
uint8_t info_payload[9]; //sg_led_res_get_info
|
|||
|
|
uint8_t block[16]; //sg_nfc_res_mifare_read_block
|
|||
|
|
struct { //sg_nfc_res_poll
|
|||
|
|
uint8_t count;
|
|||
|
|
uint8_t type;
|
|||
|
|
uint8_t id_len;
|
|||
|
|
union {
|
|||
|
|
uint8_t mifare_uid[4];
|
|||
|
|
struct {
|
|||
|
|
uint8_t IDm[8];
|
|||
|
|
uint8_t PMm[8];
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
struct { //sg_nfc_res_felica_encap
|
|||
|
|
uint8_t encap_len;
|
|||
|
|
uint8_t encap_code;
|
|||
|
|
uint8_t encap_IDm[8];
|
|||
|
|
union {
|
|||
|
|
struct {//FELICA_CMD_POLL
|
|||
|
|
uint8_t poll_PMm[8];
|
|||
|
|
uint8_t poll_systemCode[2];
|
|||
|
|
};
|
|||
|
|
struct {
|
|||
|
|
uint8_t RW_status[2];//猜测,NDA_06,NDA_08
|
|||
|
|
uint8_t numBlock;//NDA_06
|
|||
|
|
uint8_t blockData[1][1][16];//NDA_06
|
|||
|
|
};
|
|||
|
|
uint8_t felica_payload[1];
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
};
|
|||
|
|
} packet_res_t;
|
|||
|
|
|
|||
|
|
static packet_req_t req;
|
|||
|
|
static packet_res_t res;
|
|||
|
|
|
|||
|
|
static void sg_res_init(uint8_t payload_len = 0) { //初始化模板
|
|||
|
|
res.frame_len = 6 + payload_len;
|
|||
|
|
res.addr = req.addr;
|
|||
|
|
res.seq_no = req.seq_no;
|
|||
|
|
res.cmd = req.cmd;
|
|||
|
|
res.status = 0;
|
|||
|
|
res.payload_len = payload_len;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_reset() { //重置读卡器
|
|||
|
|
nfc.begin();
|
|||
|
|
nfc.setPassiveActivationRetries(0x01); //设定等待次数,0xFF永远等待
|
|||
|
|
nfc.SAMConfig();
|
|||
|
|
if (nfc.getFirmwareVersion()) {
|
|||
|
|
nfc.SAMConfig();
|
|||
|
|
sg_res_init();
|
|||
|
|
res.status = 3;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
FastLED.showColor(0xFF0000);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_get_fw_version() {
|
|||
|
|
sg_res_init(23);
|
|||
|
|
memcpy(res.version, "TN32MSEC003S F/W Ver1.2", 23);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_get_hw_version() {
|
|||
|
|
sg_res_init(23);
|
|||
|
|
memcpy(res.version, "TN32MSEC003S H/W Ver3.0", 23);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_mifare_set_key_aime() {
|
|||
|
|
sg_res_init();
|
|||
|
|
memcpy(AimeKey, req.key, 6);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_mifare_set_key_bana() {
|
|||
|
|
sg_res_init();
|
|||
|
|
memcpy(BanaKey, req.key, 6);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_led_cmd_reset() {
|
|||
|
|
sg_res_init();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_led_cmd_get_info() {
|
|||
|
|
sg_res_init(9);
|
|||
|
|
static uint8_t info[9] = {'1', '5', '0', '8', '4', 0xFF, 0x10, 0x00, 0x12};
|
|||
|
|
memcpy(res.info_payload, info, 9);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_led_cmd_set_color() {
|
|||
|
|
FastLED.showColor(CRGB(req.color_payload[0], req.color_payload[1], req.color_payload[2]));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_radio_on() {
|
|||
|
|
sg_res_init();
|
|||
|
|
nfc.setRFField(0x00, 0x01);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_radio_off() {
|
|||
|
|
sg_res_init();
|
|||
|
|
nfc.setRFField(0x00, 0x00);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_poll() { //卡号发送
|
|||
|
|
uint16_t SystemCode;
|
|||
|
|
if (nfc.readPassiveTargetID(PN532_MIFARE_ISO14443A, res.mifare_uid, &res.id_len)) {
|
|||
|
|
sg_res_init(0x07);
|
|||
|
|
res.count = 1;
|
|||
|
|
res.type = 0x10;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
else if (nfc.felica_Polling(0xFFFF, 0x00, res.IDm, res.PMm, &SystemCode, 200) == 1) {//< 0: error
|
|||
|
|
sg_res_init(0x13);
|
|||
|
|
res.count = 1;
|
|||
|
|
res.type = 0x20;
|
|||
|
|
res.id_len = 0x10;
|
|||
|
|
return;
|
|||
|
|
} else {
|
|||
|
|
sg_res_init(1);
|
|||
|
|
res.count = 0;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_mifare_select_tag() {
|
|||
|
|
sg_res_init();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_aime_authenticate() {
|
|||
|
|
sg_res_init();
|
|||
|
|
//AuthenticateBlock(uid,uidLen,block,keyType(A=0,B=1),keyData)
|
|||
|
|
if (nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 1, AimeKey)) {
|
|||
|
|
return;
|
|||
|
|
} else {
|
|||
|
|
res.status = 1;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_bana_authenticate() {
|
|||
|
|
sg_res_init();
|
|||
|
|
//AuthenticateBlock(uid,uidLen,block,keyType(A=0,B=1),keyData)
|
|||
|
|
if (nfc.mifareclassic_AuthenticateBlock(req.uid, 4, req.block_no, 0, BanaKey)) {
|
|||
|
|
return;
|
|||
|
|
} else {
|
|||
|
|
res.status = 1;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_mifare_read_block() {//读取卡扇区数据
|
|||
|
|
if (nfc.mifareclassic_ReadDataBlock(req.block_no, res.block)) {
|
|||
|
|
sg_res_init(0x10);
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
sg_res_init();
|
|||
|
|
res.status = 1;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
static void sg_nfc_cmd_felica_encap() {
|
|||
|
|
uint16_t SystemCode;
|
|||
|
|
if (nfc.felica_Polling(0xFFFF, 0x01, res.encap_IDm, res.poll_PMm, &SystemCode, 200) == 1) {
|
|||
|
|
SystemCode = SystemCode >> 8 | SystemCode << 8;//SystemCode，大小端反转注意
|
|||
|
|
}
|
|||
|
|
else {
|
|||
|
|
sg_res_init();
|
|||
|
|
res.status = 1;
|
|||
|
|
return;
|
|||
|
|
}
|
|||
|
|
uint8_t code = req.encap_code;
|
|||
|
|
res.encap_code = code + 1;
|
|||
|
|
switch (code) {
|
|||
|
|
case FELICA_CMD_POLL:
|
|||
|
|
{
|
|||
|
|
sg_res_init(0x14);
|
|||
|
|
res.poll_systemCode[0] = SystemCode;
|
|||
|
|
res.poll_systemCode[1] = SystemCode >> 8;
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case FELICA_CMD_GET_SYSTEM_CODE:
|
|||
|
|
{
|
|||
|
|
sg_res_init(0x0D);
|
|||
|
|
res.felica_payload[0] = 0x01;//未知
|
|||
|
|
res.felica_payload[1] = SystemCode;//SystemCode
|
|||
|
|
res.felica_payload[2] = SystemCode >> 8;
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case FELICA_CMD_NDA_A4:
|
|||
|
|
{
|
|||
|
|
sg_res_init(0x0B);
|
|||
|
|
res.felica_payload[0] = 0x00;
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case FELICA_CMD_NDA_06:
|
|||
|
|
{
|
|||
|
|
uint16_t serviceCodeList[1] = {(uint16_t)(req.serviceCodeList[1] << 8 | req.serviceCodeList[0])};//大小端反转注意
|
|||
|
|
for (uint8_t i = 0; i < req.numBlock; i++) {
|
|||
|
|
uint16_t blockList[1] = {(uint16_t)(req.blockList[i][0] << 8 | req.blockList[i][1])};
|
|||
|
|
if (nfc.felica_ReadWithoutEncryption(1, serviceCodeList, 1, blockList, res.blockData[i]) != 1) {
|
|||
|
|
memset(res.blockData[i], 0, 16);//dummy data
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
res.RW_status[0] = 0;
|
|||
|
|
res.RW_status[1] = 0;
|
|||
|
|
res.numBlock = req.numBlock;
|
|||
|
|
sg_res_init(0x0D + req.numBlock * 16);
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
case FELICA_CMD_NDA_08:
|
|||
|
|
{
|
|||
|
|
sg_res_init(0x0C);//此处应有写入卡，但是不打算实现
|
|||
|
|
res.RW_status[0] = 0;
|
|||
|
|
res.RW_status[1] = 0;
|
|||
|
|
}
|
|||
|
|
break;
|
|||
|
|
default:
|
|||
|
|
sg_res_init();
|
|||
|
|
res.status = 1;
|
|||
|
|
}
|
|||
|
|
res.encap_len = res.payload_len;
|
|||
|
|
}
|