Hi All,
I am trying to interface Arduino Mini with Suunto Heart Rate Strap (with ANT support). I am using nrF24AP1 transceiver board from Sparkfun.
I modified smysnk code for Arduino Mini.
I am using 2 serial port. AVR serial port to send feedback to my PC at 9600, and newSoftserial based serial port to communicate with Sparkfun’s ANT board at 4800.
Code compiles fine. But I am having hard time to figure out what is going wrong. I am not receiving any data packets on Softserial port. 
Please suggest how to proceed.
#include <NewSoftSerial.h>
#define UCHAR unsigned char
#define rxPin 2
#define txPin 3
#define ledPin 13
// set up a new serial port
NewSoftSerial mySerial = NewSoftSerial(rxPin, txPin);
byte pinState = 0;
#define RETURN_ERROR -1
#define RETURN_SUCCESS 0
#define DEBUG 1
#define MESG_TX_SYNC ((UCHAR)0xA4)
#define MESG_RX_SYNC ((UCHAR)0xA5)
#define MESG_SIZE_OFFSET ((UCHAR)1)
#define MESG_ID_OFFSET ((UCHAR)2)
#define MESG_SYNC_SIZE ((UCHAR)1)
#define MESG_SIZE_SIZE ((UCHAR)1)
#define MESG_ID_SIZE ((UCHAR)1)
#define MESG_CHECKSUM_SIZE ((UCHAR)1)
#define MESG_MAX_DATA_SIZE ((UCHAR)17)
#define MESG_HEADER_SIZE (MESG_SYNC_SIZE + MESG_SIZE_SIZE + MESG_ID_SIZE)
#define MESG_DATA_OFFSET MESG_HEADER_SIZE
#define MESG_FRAME_SIZE (MESG_HEADER_SIZE + MESG_CHECKSUM_SIZE)
#define MESG_MAX_SIZE (MESG_MAX_DATA_SIZE + MESG_FRAME_SIZE)
//////////////////////////////////////////////
// Message ID's
//////////////////////////////////////////////
#define MESG_INVALID_ID ((UCHAR)0x00)
#define MESG_EVENT_ID ((UCHAR)0x01)
#define MESG_VERSION_ID ((UCHAR)0x3E) // protocol library version
#define MESG_RESPONSE_EVENT_ID ((UCHAR)0x40)
#define MESG_UNASSIGN_CHANNEL_ID ((UCHAR)0x41)
#define MESG_ASSIGN_CHANNEL_ID ((UCHAR)0x42)
#define MESG_CHANNEL_MESG_PERIOD_ID ((UCHAR)0x43)
#define MESG_CHANNEL_SEARCH_TIMEOUT_ID ((UCHAR)0x44)
#define MESG_CHANNEL_RADIO_FREQ_ID ((UCHAR)0x45)
#define MESG_NETWORK_KEY_ID ((UCHAR)0x46)
#define MESG_RADIO_TX_POWER_ID ((UCHAR)0x47)
#define MESG_RADIO_CW_MODE_ID ((UCHAR)0x48)
#define MESG_SEARCH_WAVEFORM_ID ((UCHAR)0x49)
#define MESG_SYSTEM_RESET_ID ((UCHAR)0x4A)
#define MESG_OPEN_CHANNEL_ID ((UCHAR)0x4B)
#define MESG_CLOSE_CHANNEL_ID ((UCHAR)0x4C)
#define MESG_REQUEST_ID ((UCHAR)0x4D)
#define MESG_BROADCAST_DATA_ID ((UCHAR)0x4E)
#define MESG_ACKNOWLEDGED_DATA_ID ((UCHAR)0x4F)
#define MESG_BURST_DATA_ID ((UCHAR)0x50)
#define MESG_CHANNEL_ID_ID ((UCHAR)0x51)
#define MESG_CHANNEL_STATUS_ID ((UCHAR)0x52)
#define MESG_RADIO_CW_INIT_ID ((UCHAR)0x53)
#define MESG_CAPABILITIES_ID ((UCHAR)0x54)
#define MESG_NVM_DATA_ID ((UCHAR)0x56)
#define MESG_NVM_CMD_ID ((UCHAR)0x57)
#define MESG_NVM_STRING_ID ((UCHAR)0x58)
#define MESG_ID_LIST_ADD_ID ((UCHAR)0x59)
#define MESG_ID_LIST_CONFIG_ID ((UCHAR)0x5A)
#define MESG_OPEN_RX_SCAN_ID ((UCHAR)0x5B)
#define MESG_EXT_CHANNEL_RADIO_FREQ_ID ((UCHAR)0x5C)
#define MESG_EXT_BROADCAST_DATA_ID ((UCHAR)0x5D)
#define MESG_EXT_ACKNOWLEDGED_DATA_ID ((UCHAR)0x5E)
#define MESG_EXT_BURST_DATA_ID ((UCHAR)0x5F)
#define MESG_CHANNEL_RADIO_TX_POWER_ID ((UCHAR)0x60)
#define MESG_GET_SERIAL_NUM_ID ((UCHAR)0x61)
#define MESG_GET_TEMP_CAL_ID ((UCHAR)0x62)
#define MESG_SET_LP_SEARCH_TIMEOUT_ID ((UCHAR)0x63)
#define MESG_SET_TX_SEARCH_ON_NEXT_ID ((UCHAR)0x64)
#define MESG_SERIAL_NUM_SET_CHANNEL_ID_ID ((UCHAR)0x65)
#define MESG_RX_EXT_MESGS_ENABLE_ID ((UCHAR)0x66)
#define MESG_RADIO_CONFIG_ALWAYS_ID ((UCHAR)0x67)
#define MESG_ENABLE_LED_FLASH_ID ((UCHAR)0x68)
#define MESG_AGC_CONFIG_ID ((UCHAR)0x6A)
#define MESG_READ_SEGA_ID ((UCHAR)0xA0)
#define MESG_SEGA_CMD_ID ((UCHAR)0xA1)
#define MESG_SEGA_DATA_ID ((UCHAR)0xA2)
#define MESG_SEGA_ERASE_ID ((UCHAR)0XA3)
#define MESG_SEGA_WRITE_ID ((UCHAR)0XA4)
// ((UCHAR)0xA5) //FREE
#define MESG_SEGA_LOCK_ID ((UCHAR)0xA6)
#define MESG_FUSECHECK_ID ((UCHAR)0xA7)
#define MESG_UARTREG_ID ((UCHAR)0XA8)
#define MESG_MAN_TEMP_ID ((UCHAR)0xA9)
#define MESG_BIST_ID ((UCHAR)0XAA)
#define MESG_SELFERASE_ID ((UCHAR)0XAB)
#define MESG_SET_MFG_BITS_ID ((UCHAR)0xAC)
#define MESG_UNLOCK_INTERFACE_ID ((UCHAR)0xAD)
#define MESG_IO_STATE_ID ((UCHAR)0xB0)
#define MESG_CFG_STATE_ID ((UCHAR)0xB1)
#define MESG_RSSI_ID ((UCHAR)0xC0)
#define MESG_RSSI_BROADCAST_DATA_ID ((UCHAR)0xC1)
#define MESG_RSSI_ACKNOWLEDGED_DATA_ID ((UCHAR)0xC2)
#define MESG_RSSI_BURST_DATA_ID ((UCHAR)0xC3)
#define MESG_RSSI_SEARCH_THRESHOLD_ID ((UCHAR)0xC4)
#define MESG_BTH_BROADCAST_DATA_ID ((UCHAR)0xD0)
#define MESG_BTH_ACKNOWLEDGED_DATA_ID ((UCHAR)0xD1)
#define MESG_BTH_BURST_DATA_ID ((UCHAR)0xD2)
#define MESG_BTH_EXT_BROADCAST_DATA_ID ((UCHAR)0xD3)
#define MESG_BTH_EXT_ACKNOWLEDGED_DATA_ID ((UCHAR)0xD4)
#define MESG_BTH_EXT_BURST_DATA_ID ((UCHAR)0xD5)
//////////////////////////////////////////////
// Message Sizes
//////////////////////////////////////////////
#define MESG_INVALID_SIZE ((UCHAR)0)
#define MESG_RESPONSE_EVENT_SIZE ((UCHAR)3)
#define MESG_CHANNEL_STATUS_SIZE ((UCHAR)2)
#define MESG_VERSION_SIZE ((UCHAR)9)
#define MESG_UNASSIGN_CHANNEL_SIZE ((UCHAR)1)
#define MESG_ASSIGN_CHANNEL_SIZE ((UCHAR)3)
#define MESG_CHANNEL_ID_SIZE ((UCHAR)5)
#define MESG_CHANNEL_MESG_PERIOD_SIZE ((UCHAR)3)
#define MESG_CHANNEL_SEARCH_TIMEOUT_SIZE ((UCHAR)2)
#define MESG_CHANNEL_RADIO_FREQ_SIZE ((UCHAR)2)
#define MESG_NETWORK_KEY_SIZE ((UCHAR)9)
#define MESG_RADIO_TX_POWER_SIZE ((UCHAR)2)
#define MESG_RADIO_CW_MODE_SIZE ((UCHAR)3)
#define MESG_RADIO_CW_INIT_SIZE ((UCHAR)1)
#define MESG_SEARCH_WAVEFORM_SIZE ((UCHAR)3)
#define MESG_SYSTEM_RESET_SIZE ((UCHAR)1)
#define MESG_OPEN_CHANNEL_SIZE ((UCHAR)1)
#define MESG_CLOSE_CHANNEL_SIZE ((UCHAR)1)
#define MESG_REQUEST_SIZE ((UCHAR)2)
#define MESG_CAPABILITIES_SIZE ((UCHAR)6)
#define MESG_DATA_SIZE ((UCHAR)9)
#define MESG_NVM_DATA_SIZE ((UCHAR)10)
#define MESG_NVM_CMD_SIZE ((UCHAR)3)
#define MESG_NVM_STRING_SIZE ((UCHAR)9)
#define MESG_ID_LIST_ADD_SIZE ((UCHAR)6)
#define MESG_ID_LIST_CONFIG_SIZE ((UCHAR)3)
#define MESG_OPEN_RX_SCAN_SIZE ((UCHAR)1)
#define MESG_EXT_CHANNEL_RADIO_FREQ_SIZE ((UCHAR)3)
#define MESG_EXT_DATA_SIZE ((UCHAR)13)
#define MESG_RADIO_CONFIG_ALWAYS_SIZE ((UCHAR)2)
#define MESG_RX_EXT_MESGS_ENABLE_SIZE ((UCHAR)2)
#define MESG_SET_TX_SEARCH_ON_NEXT_SIZE ((UCHAR)2)
#define MESG_SET_LP_SEARCH_TIMEOUT_SIZE ((UCHAR)2)
#define MESG_SERIAL_NUM_SET_CHANNEL_ID_SIZE ((UCHAR)3)
#define MESG_ENABLE_LED_FLASH_SIZE ((UCHAR)2)
#define MESG_GET_SERIAL_NUM_SIZE ((UCHAR)4)
#define MESG_GET_TEMP_CAL_SIZE ((UCHAR)4)
#define MESG_AGC_CONFIG_SIZE ((UCHAR)2)
#define MESG_READ_SEGA_SIZE ((UCHAR)2)
#define MESG_SEGA_CMD_SIZE ((UCHAR)3)
#define MESG_SEGA_DATA_SIZE ((UCHAR)10)
#define MESG_SEGA_ERASE_SIZE ((UCHAR)0)
#define MESG_SEGA_WRITE_SIZE ((UCHAR)3)
#define MESG_SEGA_LOCKED_SIZE ((UCHAR)1)
#define MESG_SEGA_LOCK_SIZE ((UCHAR)0)
#define MESG_FUSECHECK_SIZE ((UCHAR)1)
#define MESG_UARTREG_SIZE ((UCHAR)2)
#define MESG_MAN_TEMP_SIZE ((UCHAR)2)
#define MESG_BIST_SIZE ((UCHAR)6)
#define MESG_SELFERASE_SIZE ((UCHAR)2)
#define MESG_SET_MFG_BITS_SIZE ((UCHAR)2)
#define MESG_UNLOCK_INTERFACE_SIZE ((UCHAR)1)
#define MESG_IO_STATE_SIZE ((UCHAR)2)
#define MESG_CFG_STATE_SIZE ((UCHAR)2)
#define MESG_RSSI_SIZE ((UCHAR)3)
#define MESG_RSSI_DATA_SIZE ((UCHAR)17)
#define MESG_RSSI_SEARCH_THRESHOLD_SIZE ((UCHAR)2)
#define RETURN_ERROR -1
#define RETURN_SUCCESS 0
#define DEBUG 1
// Ant Stuff
#define MAXMSG 14 // SYNC,LEN,MSG,data[8],CHKSUM
#define CHAN0 0
#define CHAN1 1
#define NET0 0
#define NET1 1
#define TIMEOUT 30
#define BAUD 4800 // Sparkfun ANT Default Baud
#define FREQ 0x41; // Suunto radio frequency
#define PERIOD 0x199a; // Suunto search period
#define NETWORK_KEY "B9AD3228757EC74D" // Suunto HRM
// Macros
#define hexval(c) ((c >= '0' && c <= '9') ? (c-'0') : ((c&0xdf)-'A'+10))
#define TRUE 1
#define FALSE 0
#if !defined(NULL)
#define NULL ((void *) 0)
#endif
#define MAX_UCHAR 0xFF
#define MAX_SCHAR 0x7F
#define MIN_SCHAR 0x80
#define MAX_SHORT 0x7FFF
#define MIN_SHORT 0x8000
#define MAX_USHORT 0xFFFF
#define MAX_SSHORT 0x7FFF
#define MIN_SSHORT 0x8000
#define MAX_LONG 0x7FFFFFFF
#define MIN_LONG 0x80000000
#define MAX_ULONG 0xFFFFFFFF
#define MAX_SLONG 0x7FFFFFFF
#define MIN_SLONG 0x80000000
// GLOBAL VARIABLES
///////////////////
UCHAR rxBuf[MAXMSG];
UCHAR checkSum(UCHAR *data, int length)
{
int i;
UCHAR chksum = data[0];
for (i = 1; i < length; i++)
chksum ^= data[i]; // +1 since skip prefix sync code, we already counted it
return chksum;
}
int hstr2hex(UCHAR *hex, char *hexstr, int size)
{
int i;
if ((size % 2) != 0)
{
Serial.println("hstr2hex error: input hex string has to be divisible by 2");
exit(RETURN_ERROR);
}
for (i=0; i < (size/2); i++)
{
hex[i] = hexval(hexstr[i*2])*16 + hexval(hexstr[i*2 + 1]);
}
return RETURN_SUCCESS;
}
//ANT_send(1+1, MESG_SYSTEM_RESET_ID, 0x00)
// Resets module
void reset (void)
{
uint8_t i;
uint8_t buf[4];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x01; // LENGTH Byte
buf[2] = MESG_SYSTEM_RESET_ID; // ID Byte
buf[3] = 0x00; // Data Byte N (N=LENGTH)
buf[4] = checkSum(buf,4);
for(i = 0 ; i < 5 ; i++)
mySerial.print(buf[i]);
}
//ANT_send(1+2, MESG_REQUEST_ID, CHAN0, MESG_CAPABILITIES_ID)
void assignch(void)
{
uint8_t i;
uint8_t buf[5];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x02; // LENGTH Byte
buf[2] = MESG_REQUEST_ID; // ID Byte
buf[3] = CHAN0; //
buf[4] = MESG_CAPABILITIES_ID; //
buf[5] = checkSum(buf,5);
for(i = 0 ; i < 6 ; i++)
mySerial.print(buf[i]);
}
// ANT_send(1+2, MESG_REQUEST_ID, CHAN0, 0x3D)
void assignch1(void)
{
uint8_t i;
uint8_t buf[5];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x02; // LENGTH Byte
buf[2] = MESG_REQUEST_ID; // ID Byte
buf[3] = CHAN0; //
buf[4] = ((UCHAR)0x3D); //
buf[5] = checkSum(buf,5);
for(i = 0 ; i < 6 ; i++)
mySerial.print(buf[i]);
}
// ANT_send(1+3, MESG_ASSIGN_CHANNEL_ID, CHAN0, 0x00, NET0); // chan, chtype (0=wildcard?), network
void assignch2(void)
{
uint8_t i;
uint8_t buf[6];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x03; // LENGTH Byte
buf[2] = MESG_ASSIGN_CHANNEL_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = ((UCHAR)0x00);
buf[5] = NET0;
buf[6] = checkSum(buf,6);
for(i = 0 ; i < 7 ; i++)
mySerial.print(buf[i]);
}
// ANT_send(1+5, MESG_CHANNEL_ID_ID, CHAN0, 0x00, 0x00, 0x00, 0x00); // chan, devno (2byte) (0=wildcard) (little-endian), devtype (0=wildcard), manid (0=wildcard));
void assignch3(void)
{
uint8_t i;
uint8_t buf[8];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x05; // LENGTH Byte
buf[2] = MESG_CHANNEL_ID_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = ((UCHAR)0x00);
buf[5] = ((UCHAR)0x00);
buf[6] = ((UCHAR)0x00);
buf[7] = ((UCHAR)0x00);
buf[8] = checkSum(buf,8);
for(i = 0 ; i < 9 ; i++)
mySerial.print(buf[i]);
}
// MESG_NETWORK_KEY_ID, net1, GARMIN_KEY
// buf[0] = MESG_NETWORK_KEY_ID;
// buf[1] = NET0;
// hstr2hex(&buf[2], NETWORK_KEY, 16); // dest, orig, size
// ANT_sendStr(1+9, buf);
void assignch4(void)
{
uint8_t i;
uint8_t buf[12];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x09; // LENGTH Byte
buf[2] = MESG_NETWORK_KEY_ID; // ID Byte
buf[3] = NET0;
hstr2hex(&buf[2], NETWORK_KEY, 16); // dest, orig, size
buf[12] = checkSum(buf,12);
for(i = 0 ; i < 13 ; i++)
mySerial.print(buf[i]);
}
//ANT_send(1+2, MESG_CHANNEL_SEARCH_TIMEOUT_ID, CHAN0, TIMEOUT); // MESG_CHANNEL_SEARCH_TIMEOUT_ID, chan, timeout);
void timeout(void)
{
uint8_t i;
uint8_t buf[5];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x02; // LENGTH Byte
buf[2] = MESG_CHANNEL_SEARCH_TIMEOUT_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = TIMEOUT;
buf[5] = checkSum(buf,5);
for(i = 0 ; i < 6 ; i++)
mySerial.print(buf[i]);
}
//ANT_send(1+2, MESG_CHANNEL_RADIO_FREQ_ID, CHAN0, FREQ);
void frequency(void)
{
uint8_t i;
uint8_t buf[5];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x02; // LENGTH Byte
buf[2] = MESG_CHANNEL_RADIO_FREQ_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = FREQ;
buf[5] = checkSum(buf,5);
for(i = 0 ; i < 6 ; i++)
mySerial.print(buf[i]);
}
//ANT_send(1+3, MESG_CHANNEL_MESG_PERIOD_ID, CHAN0, PERIOD%256, PERIOD/256); // NOTE: Period = Little-endian
void channel_period(void)
{
uint8_t i;
uint8_t buf[6];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x03; // LENGTH Byte
buf[2] = MESG_CHANNEL_MESG_PERIOD_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = 0x9A;
buf[5] = 0x19; // 6554 = 25*256 + 154; 25=0x19; 154 = 0x9A
buf[6] = checkSum(buf,6);
for(i = 0 ; i < 7 ; i++)
mySerial.print(buf[i]);
}
//ANT_send(1+1, MESG_OPEN_CHANNEL_ID, CHAN0); // MESG_OPEN_CHANNEL_ID, chan
void open_channel(void)
{
uint8_t i;
uint8_t buf[4];
buf[0] = MESG_TX_SYNC; // SYNC Byte
buf[1] = 0x01; // LENGTH Byte
buf[2] = MESG_OPEN_CHANNEL_ID; // ID Byte
buf[3] = CHAN0;
buf[4] = checkSum(buf,4);
for(i = 0 ; i < 5 ; i++)
mySerial.print(buf[i]);
}
void config (void)
{
reset();
delay(1000);
assignch();
delay(1000);
assignch1();
delay(1000);
assignch2();
delay(1000);
assignch3();
delay(1000);
assignch4();
delay(1000);
timeout();
delay(1000);
frequency();
delay(1000);
channel_period();
delay(1000);
open_channel();
delay(1000);
Serial.println("Config Done");
}
int ANT_rxHandler()
{
int n, fd, rc, inmsg = FALSE;
UCHAR chr, msgN;
while (mySerial.available()>0)
{
Serial.println("Data Available");
chr = mySerial.read();
if (chr == -1)
{
Serial.println("Unknown error has occured");
}
else
{
if ((chr == MESG_TX_SYNC) && (inmsg == FALSE))
{
msgN = 0; // Always reset msg count if we get a sync
inmsg = TRUE;
rxBuf[msgN] = chr; // second byte will be msg size
msgN++;
Serial.print("RX: [sync]");
}
else if (msgN == 1)
{
rxBuf[msgN] = chr; // second byte will be msg siz
msgN++;
Serial.print("..0x");
Serial.print(chr,HEX);
}
else if (msgN == 2)
{
rxBuf[msgN] = chr;
msgN++;
Serial.print("..0x");
Serial.print(chr,HEX);
}
else if (msgN < rxBuf[1]+3) // sync, size, checksum x 1 byte
{
rxBuf[msgN] = chr;
msgN++;
Serial.print("..0x");
Serial.print(chr,HEX);
}
else
{
inmsg = FALSE;
rxBuf[msgN] = chr;
Serial.print("..0x");
Serial.println(chr,HEX);
if (checkSum(rxBuf, msgN) == rxBuf[msgN]) // Check if chksum = msg chksu
{
Serial.print("RX: msg received-");
Serial.println(msgN);
ANT_rxMsg();
}
else
{
Serial.println("RX: chksum mismatch");
}
}
}
}
}
int ANT_rxMsg()
{
//int i;
UCHAR msgID, msgSize;
UCHAR *msgData;
// copy args
// memcpy(rxBuf, args, sizeof(UCHAR) * MAXMSG);
msgID = rxBuf[2];
msgSize = rxBuf[1];
msgData = &rxBuf[3];
switch (msgID)
{
case MESG_RESPONSE_EVENT_ID : Serial.println("ID: MESG_RESPONSE_EVENT_ID");
// ANT_responseHandler(msgData, msgSize);
break;
case MESG_CAPABILITIES_ID : Serial.println("ID: MESG_CAPABILITIES_ID");
// ANT_cfgCapabilties(msgData, &cfgCapb, msgSize); // rxBuf[3] .. skip sync, size, msg id
break;
case MESG_BROADCAST_DATA_ID : Serial.println("ID: MESG_BROADCAST_DATA_ID");
// ANT_parseHRM(msgData, msgSize);
break;
default : Serial.println("ID: Unknown msgID");
}
Serial.println(" ");
}
void setup() {
// define pin modes for tx, rx, led pins:
pinMode(rxPin, INPUT);
pinMode(txPin, OUTPUT);
pinMode(ledPin, OUTPUT);
// set the data rate for the SoftwareSerial port
mySerial.begin(BAUD);
Serial.begin(9600);
config();
}
void loop()
{
ANT_rxHandler();
}