|  | 
|  | 1 | +/*********************************** | 
|  | 2 | + * AntPlus Bicycle Power Display example | 
|  | 3 | + * | 
|  | 4 | + * Finds a nearby Bike Power Sensor, pairs | 
|  | 5 | + * to it and then reads the information | 
|  | 6 | + * out via the serial port. | 
|  | 7 | + * | 
|  | 8 | + * Example built for ESP32 | 
|  | 9 | + * Note: HardwareSerial required for this controller | 
|  | 10 | + * | 
|  | 11 | + * Author Andrew Hillier | 
|  | 12 | +* based on the work of Curtis Malainey | 
|  | 13 | + ************************************/ | 
|  | 14 | +#include <Arduino.h> | 
|  | 15 | +#include "ANT.h" | 
|  | 16 | +#include "ANTPLUS.h" | 
|  | 17 | +#include <HardwareSerial.h> | 
|  | 18 | + | 
|  | 19 | +#define BAUD_RATE 9600 | 
|  | 20 | +#define CHANNEL_0 0 | 
|  | 21 | + | 
|  | 22 | +const uint8_t NETWORK_KEY[] = {0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77}; // get this from thisisant.com | 
|  | 23 | + | 
|  | 24 | +// ************************************* | 
|  | 25 | +// Specific to test ANT+ chip and ESP32 setup | 
|  | 26 | +const int RTS_PIN = 23; | 
|  | 27 | +const int SUSPEND_PIN = 22; | 
|  | 28 | +const int SLEEP_PIN = 19; | 
|  | 29 | +const int RESET_PIN = 2; | 
|  | 30 | +const int TX_PIN = 17; | 
|  | 31 | +const int RX_PIN = 16; | 
|  | 32 | + | 
|  | 33 | +HardwareSerial antSerial(2); | 
|  | 34 | + | 
|  | 35 | +// ************************************* | 
|  | 36 | + | 
|  | 37 | +ArduinoSerialAntWithCallbacks ant; | 
|  | 38 | +AntPlusRouter router; | 
|  | 39 | +ProfileBicyclePowerDisplay bikePower; | 
|  | 40 | + | 
|  | 41 | +void bicyclePowerBaseDataPageHandler(AntRxDataResponse& msg, uintptr_t data); | 
|  | 42 | +void batteryStatusDataPageHandler(BicyclePowerBatteryStatus& msg, uintptr_t data); | 
|  | 43 | +void cumulativeOperatingTimeDataPageHandler(BicyclePowerCumulativeOperatingTime& msg, uintptr_t data); | 
|  | 44 | +void manufacturerIDDataPageHandler(BicyclePowerManufacturerID& msg, uintptr_t data); | 
|  | 45 | +void productIDDataPageHandler(BicyclePowerProductID& msg, uintptr_t data); | 
|  | 46 | +void powerOnlyDataPageHandler(BicyclePowerPowerOnly& msg, uintptr_t data); | 
|  | 47 | +void crankTorqueDataPageHandler(BicyclePowerCrankTorque& msg, uintptr_t data); | 
|  | 48 | +void wheelTorqueDataPageHandler(BicyclePowerWheelTorque& msg, uintptr_t data); | 
|  | 49 | +void pedalSmoothnessDataPageHandler(BicyclePowerPedalSmoothness& msg, uintptr_t data); | 
|  | 50 | + | 
|  | 51 | +void bicyclePowerBatteryStatus(uint8_t flags); | 
|  | 52 | +void printStatus(uint8_t status); | 
|  | 53 | + | 
|  | 54 | +void setup() { | 
|  | 55 | + | 
|  | 56 | +// Powering on the ANT+ chip | 
|  | 57 | +// ************************************* | 
|  | 58 | + | 
|  | 59 | + pinMode(SUSPEND_PIN, OUTPUT); | 
|  | 60 | + pinMode(SLEEP_PIN, OUTPUT); | 
|  | 61 | + pinMode(RESET_PIN, OUTPUT); | 
|  | 62 | + pinMode(RTS_PIN, INPUT); | 
|  | 63 | + | 
|  | 64 | + digitalWrite(RESET_PIN, HIGH); | 
|  | 65 | + digitalWrite(SUSPEND_PIN, HIGH); | 
|  | 66 | + digitalWrite(SLEEP_PIN, LOW); | 
|  | 67 | + | 
|  | 68 | + | 
|  | 69 | +// ************************************* | 
|  | 70 | + | 
|  | 71 | + antSerial.begin(BAUD_RATE); | 
|  | 72 | + ant.setSerial(antSerial); | 
|  | 73 | + delay(15000); | 
|  | 74 | + | 
|  | 75 | + router.setDriver(&ant); // never touch ant again | 
|  | 76 | + router.setAntPlusNetworkKey(NETWORK_KEY); | 
|  | 77 | + router.setProfile(CHANNEL_0, &bikePower); | 
|  | 78 | + // Delay after initial setup to wait for user to connect on serial | 
|  | 79 | + | 
|  | 80 | + Serial.begin(BAUD_RATE); | 
|  | 81 | + Serial.println("Running"); | 
|  | 82 | + bikePower.onDataPage(bicyclePowerBaseDataPageHandler); | 
|  | 83 | + bikePower.onBicyclePowerBatteryStatus(batteryStatusDataPageHandler); | 
|  | 84 | + bikePower.onBicyclePowerCumulativeOperatingTime(cumulativeOperatingTimeDataPageHandler); | 
|  | 85 | + bikePower.onBicyclePowerManufacturerID(manufacturerIDDataPageHandler); | 
|  | 86 | + bikePower.onBicyclePowerProductID(productIDDataPageHandler); | 
|  | 87 | + bikePower.onBicyclePowerPowerOnly(powerOnlyDataPageHandler); | 
|  | 88 | + bikePower.onBicyclePowerCrankTorque(crankTorqueDataPageHandler); | 
|  | 89 | + bikePower.onBicyclePowerWheelTorque(wheelTorqueDataPageHandler); | 
|  | 90 | + bikePower.onBicyclePowerPedalSmoothness(pedalSmoothnessDataPageHandler); | 
|  | 91 | + bikePower.begin(); | 
|  | 92 | + // wait for pair to complete | 
|  | 93 | + uint8_t status = bikePower.waitForPair(); | 
|  | 94 | + // print channel status | 
|  | 95 | + Serial.println("==========================="); | 
|  | 96 | + printStatus(status); | 
|  | 97 | + Serial.print("Device Number: "); | 
|  | 98 | + Serial.println(bikePower.getDeviceNumber()); | 
|  | 99 | + Serial.print("Transmisison Type: "); | 
|  | 100 | + Serial.println(bikePower.getTransmissionType()); | 
|  | 101 | +} | 
|  | 102 | + | 
|  | 103 | +void loop() { | 
|  | 104 | + router.loop(); | 
|  | 105 | +} | 
|  | 106 | + | 
|  | 107 | +void batteryStatusDataPageHandler(BicyclePowerBatteryStatus& msg, uintptr_t data) { | 
|  | 108 | + Serial.print("Fractional Battery Voltage: "); | 
|  | 109 | + Serial.println(msg.getFractionalBatteryVoltage()); | 
|  | 110 | + Serial.print("Battery Status: "); | 
|  | 111 | + bicyclePowerBatteryStatus(msg.getBatteryStatus()); | 
|  | 112 | +} | 
|  | 113 | + | 
|  | 114 | +void cumulativeOperatingTimeDataPageHandler(BicyclePowerCumulativeOperatingTime& msg, uintptr_t data) { | 
|  | 115 | + Serial.print("Cumulative Operating Time: "); | 
|  | 116 | + Serial.println(msg.getCumulativeOperatingTime()); | 
|  | 117 | +} | 
|  | 118 | + | 
|  | 119 | +void manufacturerIDDataPageHandler(BicyclePowerManufacturerID& msg, uintptr_t data) { | 
|  | 120 | + Serial.print("Hardware ID: "); | 
|  | 121 | + Serial.println(msg.getHardwareVersion()); | 
|  | 122 | + Serial.print("Manufacturer ID: "); | 
|  | 123 | + Serial.println(msg.getManufacturerId()); | 
|  | 124 | + Serial.print("Model Number: "); | 
|  | 125 | + Serial.println(msg.getModelNumber()); | 
|  | 126 | +} | 
|  | 127 | + | 
|  | 128 | +void productIDDataPageHandler(BicyclePowerProductID& msg, uintptr_t data) { | 
|  | 129 | + Serial.print("Software Version Supplemental: "); | 
|  | 130 | + Serial.println(msg.getSoftwareVersionSupplemental()); | 
|  | 131 | + Serial.print("Software Version: "); | 
|  | 132 | + Serial.println(msg.getSoftwareVersion()); | 
|  | 133 | + Serial.print("Serial Number: "); | 
|  | 134 | + Serial.println(msg.getSerialNumber()); | 
|  | 135 | +} | 
|  | 136 | + | 
|  | 137 | +void bicyclePowerBaseDataPageHandler(AntRxDataResponse& msg, uintptr_t data) { | 
|  | 138 | + BicyclePowerBaseMainDataPage dp = BicyclePowerBaseMainDataPage(msg); | 
|  | 139 | + Serial.println("==========================="); | 
|  | 140 | + Serial.print("DataPage: "); | 
|  | 141 | + Serial.println(dp.getDataPageNumber()); | 
|  | 142 | + Serial.print("Bike Power Event Count: "); | 
|  | 143 | + Serial.println(dp.getUpdateEventCount()); | 
|  | 144 | +} | 
|  | 145 | + | 
|  | 146 | +void powerOnlyDataPageHandler(BicyclePowerPowerOnly& msg, uintptr_t data) { | 
|  | 147 | + Serial.print("Pedal Balance: "); | 
|  | 148 | + Serial.println(msg.getPedalBalance()); | 
|  | 149 | + Serial.print("Instant Cadence: "); | 
|  | 150 | + Serial.println(msg.getInstantCadence()); | 
|  | 151 | + Serial.print("Accumulated Power: "); | 
|  | 152 | + Serial.println(msg.getAccumulatedPower()); | 
|  | 153 | + Serial.print("Instant Power: "); | 
|  | 154 | + Serial.println(msg.getInstantPower()); | 
|  | 155 | +} | 
|  | 156 | + | 
|  | 157 | +void crankTorqueDataPageHandler(BicyclePowerCrankTorque& msg, uintptr_t data) { | 
|  | 158 | + Serial.print("Crank Ticks: "); | 
|  | 159 | + Serial.println(msg.getCrankTicks()); | 
|  | 160 | + Serial.print("Instant Cadence: "); | 
|  | 161 | + Serial.println(msg.getInstantCadence()); | 
|  | 162 | + Serial.print("Crank Period: "); | 
|  | 163 | + Serial.println(msg.getCrankPeriod()); | 
|  | 164 | + Serial.print("Accumulated Torque: "); | 
|  | 165 | + Serial.println(msg.getAccumulatedTorque()); | 
|  | 166 | +} | 
|  | 167 | + | 
|  | 168 | +void wheelTorqueDataPageHandler(BicyclePowerWheelTorque& msg, uintptr_t data) { | 
|  | 169 | + Serial.print("Wheel Ticks: "); | 
|  | 170 | + Serial.println(msg.getWheelTicks()); | 
|  | 171 | + Serial.print("Instant Cadence: "); | 
|  | 172 | + Serial.println(msg.getInstantCadence()); | 
|  | 173 | + Serial.print("Wheel Period: "); | 
|  | 174 | + Serial.println(msg.getWheelPeriod()); | 
|  | 175 | + Serial.print("Accumulated Torque: "); | 
|  | 176 | + Serial.println(msg.getAccumulatedTorque()); | 
|  | 177 | +} | 
|  | 178 | + | 
|  | 179 | +void pedalSmoothnessDataPageHandler(BicyclePowerPedalSmoothness& msg, uintptr_t data) { | 
|  | 180 | + Serial.print("Left Torque Effectiveness: "); | 
|  | 181 | + Serial.println(msg.getLeftTorqueEffectiveness()); | 
|  | 182 | + Serial.print("Right Torque Effectiveness: "); | 
|  | 183 | + Serial.println(msg.getRightTorqueEffectiveness()); | 
|  | 184 | + Serial.print("Left Pedal Smoothness: "); | 
|  | 185 | + Serial.println(msg.getLeftPedalSmoothness()); | 
|  | 186 | + Serial.print("Right Pedal Smoothness: "); | 
|  | 187 | + Serial.println(msg.getRightPedalSmoothness()); | 
|  | 188 | +} | 
|  | 189 | + | 
|  | 190 | +void printStatus(uint8_t status) { | 
|  | 191 | + Serial.print("Channel Status: "); | 
|  | 192 | + switch (status) { | 
|  | 193 | + case CHANNEL_STATUS_UNASSIGNED: | 
|  | 194 | + Serial.println("Unassigned"); | 
|  | 195 | + break; | 
|  | 196 | + case CHANNEL_STATUS_ASSIGNED: | 
|  | 197 | + Serial.println("Assigned"); | 
|  | 198 | + break; | 
|  | 199 | + case CHANNEL_STATUS_SEARCHING: | 
|  | 200 | + Serial.println("Searching"); | 
|  | 201 | + break; | 
|  | 202 | + case CHANNEL_STATUS_TRACKING: | 
|  | 203 | + Serial.println("Tracking"); | 
|  | 204 | + break; | 
|  | 205 | + } | 
|  | 206 | +} | 
|  | 207 | + | 
|  | 208 | +void bicyclePowerBatteryStatus(uint8_t flags) { | 
|  | 209 | + switch (flags) { | 
|  | 210 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_NEW: | 
|  | 211 | + Serial.println("New"); | 
|  | 212 | + break; | 
|  | 213 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_GOOD: | 
|  | 214 | + Serial.println("Good"); | 
|  | 215 | + break; | 
|  | 216 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_OK: | 
|  | 217 | + Serial.println("Ok"); | 
|  | 218 | + break; | 
|  | 219 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_LOW: | 
|  | 220 | + Serial.println("Low"); | 
|  | 221 | + break; | 
|  | 222 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_CRITICAL: | 
|  | 223 | + Serial.println("Critical"); | 
|  | 224 | + break; | 
|  | 225 | + case ANTPLUS_BICYCLEPOWER_DATAPAGE_BATTERYSTATUS_BATTERYSTATUS_INVALID: | 
|  | 226 | + Serial.println("Invalid"); | 
|  | 227 | + break; | 
|  | 228 | + default: | 
|  | 229 | + Serial.println("Reserved/Unknown"); | 
|  | 230 | + break; | 
|  | 231 | + } | 
|  | 232 | +} | 
0 commit comments