nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

All things pertaining to wireless and RF links

Moderator: phalanx

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby deswong » Sun Jan 22, 2012 7:29 pm

It is possible to use AntWare II to interface temporarily to the nRF24AP1 to determine if it is faulty?
deswong
 
Posts: 8
Joined: Sun Nov 27, 2011 9:45 pm

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby SmallJoeMan » Sat Jan 28, 2012 2:06 pm

Thanks for posting this code, it works beautifully on my Arduino Pro Mini :) (although I do get a lot of MESG_RESPONSE_EVENT_IDs being thrown out, is that normal?)

Clearly the 9th byte in the data stream is the heart rate but what are the other 8 data bytes describing?
SmallJoeMan
 
Posts: 1
Joined: Sat Jan 28, 2012 2:02 pm

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby march83 » Mon Jan 30, 2012 8:14 pm

^^interesting theory. could be.

I wrote what i thought was a pretty idiot-proof procedural code that should have allowed my 3.3v arduino pretend to be a powermeter and just keep sending power data that my garmin 500 could see but i couldn't get it to work either.

that said, reading this: http://jbremnant.wordpress.com/2011/11/ ... d-android/ makes me think that there's a bit more to it wrt timing that i'm not doing properly - my arduino mini 3.3v runs at half clock speed, but i feel like i've tried many, many different delays to no effect. it's very frustrating to see someone get it working seemingly so easily when i've put many hours into this and essentially gotten nowhere :\

my other theory was that the sample code posted in this thread may not work with all garmin HRMs, but i have nfi why. i hope to find some time to chop that code up and see if i can communicate with my powertap...
march83
 
Posts: 2
Joined: Sun Dec 11, 2011 5:10 pm

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby Carlos_Lema » Sat Mar 17, 2012 10:30 am

Thanks for the great post!

For some reason I am struggling to get smysnk's code to work with the Arduino Nano -- In found that the IDE 1.0's SoftwareSerial replaced the "NewSoftSerial".

Set up:
nRF24AP1 Tx --> Rx (2) Nano
nRF24AP1 Rx --> Tx (3) Nano
nRF24AP1 Vcc <-- (5) Nano --- (while testing)

It appears it initializes correctly, but never detects either Suunto/Garmin pods or belts. It just simply stops here:

Config Starting
TX: A4 1 4A 0 EF
TX: A4 2 4D 0 54 BF
TX: A4 2 4D 0 3D D6
TX: A4 3 42 0 0 0 E5
TX: A4 5 51 0 0 0 0 0 F0
TX: A4 9 46 0 B9 AD 32 28 75 7E C7 4D 64
TX: A4 2 44 0 A E8
TX: A4 2 45 0 41 A2
TX: A4 3 43 0 1F 86 7D
TX: A4 1 4B 0 EE
Config Done


In the loop, I added a
Code: Select all
println(mySerial.read())
to see what is coming in, but I get -1 I assume (RETURN_ERROR).
Looked into AntMaster (no Slave in the lib) and Mirf just for kicks, works... but is not ANT.

PS.
My goal is to collect data from 2 Interruptors, XZ Gyro and ANT/ANT+, plus Control 2-3 PWM and send/receive data via Bluetooth, for now.

The only bit missing it is getting this ANT transceiver to work!

Any help is much appreciated.

\\ carlos
Carlos_Lema
 
Posts: 4
Joined: Sat Mar 17, 2012 9:26 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby chrisiufer » Sun Apr 08, 2012 10:49 pm

Replace all the instances of
Code: Select all
mySerial.print(...)
with
Code: Select all
mySerial.write( ... )
if you are getting no response from your AP1. After tons of troubleshooting down many avenues I finally discovered that SoftwareSerial's print() method will send the data as ASCII bytes down the wire instead of the straight binary that the AP1 requires. The proper method to do this is write() which will convert the unsigned chars into binary. I hope this helps someone else who was having zero luck with this little stick. I was starting to lose hope with mine.
chrisiufer
 
Posts: 2
Joined: Mon Apr 02, 2012 7:34 pm

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby romainf » Mon Apr 09, 2012 1:08 pm

I have managed to succesfully get this working with an arduino uno and both a garmin heart rate monitor and speed/stride sensor. you can see the result here.
The main problem I encountered (see my previous post) was that it initialized but did not communicate with my devices (I used the 3,3v output from the arduino and a logic level converter). The only I got it to work was to feed it 5v (it might harm the device in the long run as it is above its recommended input voltage, but that is the only thing I could do).
if you need any help or source code, don't hesitate to ask...
romainf
 
Posts: 2
Joined: Thu Dec 01, 2011 1:02 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby Carlos_Lema » Mon Apr 09, 2012 7:44 pm

Thanks @chrisiufer for your help.

Here we go let's get everything on the same page:

Garmin FR60 Belt & Footpod as well as Suunto T3C Belt & Footpod. Arduino Nano, IDE 1.0 Mac OS Lion.

Nano ------ nRF24AP1
5v --------> Vcc
D7 Tx ----> Rx
D8 Rx <---- Tx
GND ------> GND

Here is smysnk's updated code, as per chrisiufer's help:

Code: Select all
   
#include <SoftwareSerial.h>

    #define UCHAR unsigned char

    #define rxPin 8
    #define txPin 7
    #define ledPin 13

    // set up a new serial port
    SoftwareSerial mySerial =  SoftwareSerial(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   10 //mikec  30

    #define BAUD   4800   // Sparkfun ANT Default Baud

    //#define FREQ      0x41;   // Suunto radio frequency
    #define FREQ 0x39; //  garmin radio frequency
    //#define PERIOD      0x199a; // Suunto search period
    #define PERIOD      0x1f86; // Garmin search period
    //#define NETWORK_KEY      "B9AD3228757EC74D" // Suunto HRM
    #define NETWORK_KEY      "B9A521FBBD72C345" // Garmin 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);
       Serial.print("TX: ");
       for(i = 0 ; i < 5 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
         mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    //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);
       Serial.print("TX: ");
       for(i = 0 ; i < 6 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
         mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    //   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);
       Serial.print("TX: ");
       for(i = 0 ; i < 6 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    //   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);
       Serial.print("TX: ");
       for(i = 0 ; i < 7 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    //   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);
       Serial.print("TX: ");
       for(i = 0 ; i < 9 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    // 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[4], NETWORK_KEY, 16);  // dest, orig, size
    //mikec        hstr2hex(&buf[2], NETWORK_KEY, 16);  // dest, orig, size
       buf[12] = checkSum(buf,12);
       Serial.print("TX: ");
       for(i = 0 ; i < 13 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }

    //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);
       Serial.print("TX: ");
       for(i = 0 ; i < 6 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    //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);
       Serial.print("TX: ");
       for(i = 0 ; i < 6 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }

    //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] = 0x1f; //mikec   buf[4] = 0x9A;
       buf[5] = 0x86; //mikec   buf[5] = 0x19;  //   6554 = 25*256 + 154; 25=0x19; 154 = 0x9A
            buf[6] = checkSum(buf,6);
       Serial.print("TX: ");
       for(i = 0 ; i < 7 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
       mySerial.write(buf[i]);
       }
       Serial.println("");
    }

    //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);
       Serial.print("TX: ");
       for(i = 0 ; i < 5 ; i++)
       {
         Serial.print(buf[i], HEX);
         Serial.print(" ");
         mySerial.write(buf[i]);
       }
       Serial.println("");
    }


    void config (void)
    {
       Serial.println("Config Starting");

            reset();
       delay(100);
             assignch();
       delay(1000);
             assignch1();
       delay(100);
             assignch2();
       delay(100);
             assignch3();
       delay(100);
             assignch4();
       delay(20);
             timeout();
       delay(20);
             frequency();
       delay(20);
             channel_period();
       delay(20);
             open_channel();
       delay(20);
            Serial.println("Config Done");
    }



    int ANT_rxHandler()
    {
       int n, fd, rc, inmsg = FALSE;
       UCHAR chr, msgN;
       
       while (mySerial.available()>0)
       {
          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.println("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 :   
             break;
          case MESG_CAPABILITIES_ID   :   
             break;

          case MESG_BROADCAST_DATA_ID :   
             Serial.print("Heartrate is ");
             Serial.println(msgData[msgSize-1], DEC);
             break;
                                 
          default                  :   Serial.println("ID: Unknown msgID");
         
       }
    }



    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();
    }
Carlos_Lema
 
Posts: 4
Joined: Sat Mar 17, 2012 9:26 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby Carlos_Lema » Mon Apr 09, 2012 7:50 pm

A couple of curious things:
01. The ANT reading's is sporadic: first time after 20 RX: [sync], the next 15, then 6, it goes away for a while -- very temperamental.
02. The footpod is not recognized -- might be something to do with pairing or IDs -- that for later, first things first.
03. As soon as a Garmin Watch is set up in listening mode -- I only get RX: [sync].

Future Goals:
- As is it uses 8K of memory, can it be optimized?
- How can it handle manual pairing? -- say more than 8 sensors on the network
- Can it recognize ANT Power Meters and Speed & Cadence sensors?
- Will this nRF24AP1 & code work with ANT+ or is it only for ANT
- Could it work on a ATtiny45 as a Slave to transmit telemetry?

@romainf, very cool "Runner's Wearable Display" -- would you mind posting the code to compare it to the original? Plus, it will come in handy on my long runs or rides -- kudos.

\\ carlos
Carlos_Lema
 
Posts: 4
Joined: Sat Mar 17, 2012 9:26 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby chrisiufer » Thu Apr 12, 2012 9:19 pm

@Carolos_Lema
per some of the previous posts in this thread, you may find that adding some delay and/or Serial.print() inside the rxhandler function's while loop will make things work better. I'm sure it has something to do with the timing of the while loop and some delay inherent in the SoftwareSerial library.

Manual pairing, power meters, speed/cadence sensors are all totally possible with the AP1. While this code is very basic and written specifically for displaying heartrate, it wouldnt be much work to configure channel 1, 2, and 3 to listen to other devices and display their broadcast data in some way.

Checkout these other resources for some more open source code dealing with simple ANT messaging.
GoldenEmbed https://github.com/jknotzke/GoldenEmbed/blob/master/Main/main.c
This also has a device id for the footpod but its commented out for some reason :/

Jbremnant setup master mode with Arduino and pulished the code on github
http://jbremnant.wordpress.com/2011/11/27/ant-between-msp430-and-android/
chrisiufer
 
Posts: 2
Joined: Mon Apr 02, 2012 7:34 pm

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby Carlos_Lema » Thu Apr 19, 2012 3:41 am

@chrisiufer Thanks for the links!
Carlos_Lema
 
Posts: 4
Joined: Sat Mar 17, 2012 9:26 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby asm » Fri Jul 13, 2012 8:20 am

I've written the beginnings of a C lib here: https://github.com/asm/avr_ant. Enjoy :)
asm
 
Posts: 1
Joined: Fri Jul 13, 2012 8:18 am

Re: nRF24AP1 - ANT Code - Garmin Heart-Rate Monitor

Postby forcecode » Thu Aug 09, 2012 1:32 am

I think the real problem is not with timing etc.
Just make all variables inside ANT_rxHandler() static or make them global, so the processing status is preserved between successive calls.

int ANT_rxHandler()
{
static int n, fd, rc, inmsg = FALSE;
static UCHAR chr, msgN;
forcecode
 
Posts: 1
Joined: Thu Aug 09, 2012 1:24 am

Previous

Return to Wireless/RF

Who is online

Users browsing this forum: No registered users and 1 guest