Ultrasonic
Dependencies: Cayenne-MQTT-mbed mbed Servo X_NUCLEO_IDW01M1v2 NetworkSocketAPI HCSR04
main.cpp@13:c5911ceac9ab, 2019-08-02 (annotated)
- Committer:
- stiotchallenge
- Date:
- Fri Aug 02 06:51:30 2019 +0000
- Revision:
- 13:c5911ceac9ab
- Parent:
- 12:dd98953c0a6d
Module 3: Ultrasonic
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jburhenn | 0:d20655cd1f3c | 1 | /** |
jburhenn | 0:d20655cd1f3c | 2 | * Example app for using the Cayenne MQTT C++ library to send and receive example data. This example uses |
jburhenn | 0:d20655cd1f3c | 3 | * the X-NUCLEO-IDW01M1 WiFi expansion board via the X_NUCLEO_IDW01M1v2 library. |
jburhenn | 0:d20655cd1f3c | 4 | */ |
jburhenn | 0:d20655cd1f3c | 5 | |
jburhenn | 0:d20655cd1f3c | 6 | #include "MQTTTimer.h" |
jburhenn | 0:d20655cd1f3c | 7 | #include "CayenneMQTTClient.h" |
jburhenn | 0:d20655cd1f3c | 8 | #include "MQTTNetworkIDW01M1.h" |
jburhenn | 0:d20655cd1f3c | 9 | #include "SpwfInterface.h" |
stiotchallenge | 9:e3a211745f71 | 10 | #include "hcsr04.h" |
stiotchallenge | 13:c5911ceac9ab | 11 | |
jburhenn | 0:d20655cd1f3c | 12 | |
jburhenn | 0:d20655cd1f3c | 13 | // WiFi network info. |
stiotchallenge | 8:b19f86c36974 | 14 | char* ssid = "iPhone"; |
stiotchallenge | 8:b19f86c36974 | 15 | char* wifiPassword = "abcd1234"; |
jburhenn | 0:d20655cd1f3c | 16 | |
jburhenn | 0:d20655cd1f3c | 17 | // Cayenne authentication info. This should be obtained from the Cayenne Dashboard. |
stiotchallenge | 8:b19f86c36974 | 18 | char* username = "4f3fbcb0-3796-11e9-ad96-c15442ccb423"; |
stiotchallenge | 8:b19f86c36974 | 19 | char* password = "9e099f3d9aaedd7b76ca94044c6bb488c3999e3c"; |
stiotchallenge | 9:e3a211745f71 | 20 | char* clientID = "4288d2f0-a5a9-11e9-9636-f9904f7b864b"; |
jburhenn | 0:d20655cd1f3c | 21 | |
jburhenn | 0:d20655cd1f3c | 22 | SpwfSAInterface interface(D8, D2); // TX, RX |
jburhenn | 0:d20655cd1f3c | 23 | MQTTNetwork<SpwfSAInterface> network(interface); |
jburhenn | 2:445f09de09bd | 24 | CayenneMQTT::MQTTClient<MQTTNetwork<SpwfSAInterface>, MQTTTimer> mqttClient(network, username, password, clientID); |
jburhenn | 0:d20655cd1f3c | 25 | |
stiotchallenge | 9:e3a211745f71 | 26 | DigitalIn button1(USER_BUTTON); |
jburhenn | 1:a2d8aec2bb92 | 27 | DigitalOut led1(LED1); |
stiotchallenge | 9:e3a211745f71 | 28 | DigitalOut ledGreen(D11); |
stiotchallenge | 9:e3a211745f71 | 29 | DigitalOut ledRed(D12); |
stiotchallenge | 12:dd98953c0a6d | 30 | HCSR04 sensor(D7, D6); |
stiotchallenge | 13:c5911ceac9ab | 31 | |
jburhenn | 1:a2d8aec2bb92 | 32 | |
stiotchallenge | 8:b19f86c36974 | 33 | int iotvalue; |
stiotchallenge | 9:e3a211745f71 | 34 | |
stiotchallenge | 9:e3a211745f71 | 35 | //Function prototype new |
stiotchallenge | 12:dd98953c0a6d | 36 | MQTTTimer publishData(MQTTTimer, int, int); |
stiotchallenge | 9:e3a211745f71 | 37 | MQTTTimer myFunction(MQTTTimer); |
stiotchallenge | 9:e3a211745f71 | 38 | |
stiotchallenge | 9:e3a211745f71 | 39 | MQTTTimer myFunction (MQTTTimer timer){ |
stiotchallenge | 9:e3a211745f71 | 40 | /** |
stiotchallenge | 9:e3a211745f71 | 41 | * Write your codes here. |
stiotchallenge | 9:e3a211745f71 | 42 | **/ |
stiotchallenge | 9:e3a211745f71 | 43 | led1 = 1; |
stiotchallenge | 9:e3a211745f71 | 44 | wait(0.2); |
stiotchallenge | 9:e3a211745f71 | 45 | led1 = 0; |
stiotchallenge | 9:e3a211745f71 | 46 | wait(0.2); |
stiotchallenge | 9:e3a211745f71 | 47 | |
stiotchallenge | 9:e3a211745f71 | 48 | |
stiotchallenge | 12:dd98953c0a6d | 49 | long distance = sensor.distance(); |
stiotchallenge | 12:dd98953c0a6d | 50 | printf("distance %d \n",distance); |
stiotchallenge | 12:dd98953c0a6d | 51 | wait(1.0); // 1 sec |
stiotchallenge | 12:dd98953c0a6d | 52 | if (distance > 50) { |
stiotchallenge | 12:dd98953c0a6d | 53 | ledGreen = 0; |
stiotchallenge | 12:dd98953c0a6d | 54 | ledRed = 1; |
stiotchallenge | 12:dd98953c0a6d | 55 | } |
stiotchallenge | 12:dd98953c0a6d | 56 | if (distance <50) { |
stiotchallenge | 12:dd98953c0a6d | 57 | ledGreen = 1; |
stiotchallenge | 12:dd98953c0a6d | 58 | ledRed = 0; |
stiotchallenge | 12:dd98953c0a6d | 59 | } |
stiotchallenge | 9:e3a211745f71 | 60 | |
stiotchallenge | 13:c5911ceac9ab | 61 | timer = publishData(timer, ledGreen, ledRed); |
stiotchallenge | 9:e3a211745f71 | 62 | return timer; |
stiotchallenge | 9:e3a211745f71 | 63 | } |
stiotchallenge | 9:e3a211745f71 | 64 | |
stiotchallenge | 12:dd98953c0a6d | 65 | MQTTTimer publishData(MQTTTimer timer, int data1, int data2){ |
stiotchallenge | 9:e3a211745f71 | 66 | // Publish some example data every few seconds. This should be changed to send your actual data to Cayenne. |
stiotchallenge | 9:e3a211745f71 | 67 | if (timer.expired()) { |
stiotchallenge | 9:e3a211745f71 | 68 | int error = 0; |
stiotchallenge | 9:e3a211745f71 | 69 | if ((error = mqttClient.publishData(DATA_TOPIC, 1, TYPE_VOLTAGE, UNIT_DIGITAL, data1)) != CAYENNE_SUCCESS) { |
stiotchallenge | 12:dd98953c0a6d | 70 | printf("Publish data failed, error: %d\n", error); |
stiotchallenge | 9:e3a211745f71 | 71 | } |
stiotchallenge | 12:dd98953c0a6d | 72 | if ((error = mqttClient.publishData(DATA_TOPIC, 2, TYPE_VOLTAGE, UNIT_DIGITAL, data2)) != CAYENNE_SUCCESS) { |
stiotchallenge | 12:dd98953c0a6d | 73 | printf("Publish data failed, error: %d\n", error); |
stiotchallenge | 12:dd98953c0a6d | 74 | } |
stiotchallenge | 9:e3a211745f71 | 75 | // Restart the countdown timer for publishing data every 5 seconds. Change the timeout parameter to publish at a different interval. |
stiotchallenge | 12:dd98953c0a6d | 76 | timer.countdown_ms(1500); |
stiotchallenge | 9:e3a211745f71 | 77 | } |
stiotchallenge | 9:e3a211745f71 | 78 | return timer; |
stiotchallenge | 9:e3a211745f71 | 79 | } |
stiotchallenge | 9:e3a211745f71 | 80 | |
jburhenn | 0:d20655cd1f3c | 81 | /** |
jburhenn | 0:d20655cd1f3c | 82 | * Print the message info. |
jburhenn | 0:d20655cd1f3c | 83 | * @param[in] message The message received from the Cayenne server. |
jburhenn | 0:d20655cd1f3c | 84 | */ |
jburhenn | 2:445f09de09bd | 85 | void outputMessage(CayenneMQTT::MessageData& message) |
jburhenn | 0:d20655cd1f3c | 86 | { |
jburhenn | 0:d20655cd1f3c | 87 | switch (message.topic) { |
jburhenn | 0:d20655cd1f3c | 88 | case COMMAND_TOPIC: |
jburhenn | 0:d20655cd1f3c | 89 | printf("topic=Command"); |
jburhenn | 0:d20655cd1f3c | 90 | break; |
jburhenn | 0:d20655cd1f3c | 91 | case CONFIG_TOPIC: |
jburhenn | 0:d20655cd1f3c | 92 | printf("topic=Config"); |
jburhenn | 0:d20655cd1f3c | 93 | break; |
jburhenn | 0:d20655cd1f3c | 94 | default: |
jburhenn | 0:d20655cd1f3c | 95 | printf("topic=%d", message.topic); |
jburhenn | 0:d20655cd1f3c | 96 | break; |
jburhenn | 0:d20655cd1f3c | 97 | } |
jburhenn | 0:d20655cd1f3c | 98 | printf(" channel=%d", message.channel); |
jburhenn | 0:d20655cd1f3c | 99 | if (message.clientID) { |
jburhenn | 0:d20655cd1f3c | 100 | printf(" clientID=%s", message.clientID); |
jburhenn | 0:d20655cd1f3c | 101 | } |
jburhenn | 0:d20655cd1f3c | 102 | if (message.type) { |
jburhenn | 0:d20655cd1f3c | 103 | printf(" type=%s", message.type); |
jburhenn | 0:d20655cd1f3c | 104 | } |
jburhenn | 0:d20655cd1f3c | 105 | for (size_t i = 0; i < message.valueCount; ++i) { |
jburhenn | 2:445f09de09bd | 106 | if (message.getValue(i)) { |
jburhenn | 2:445f09de09bd | 107 | printf(" value=%s", message.getValue(i)); |
jburhenn | 0:d20655cd1f3c | 108 | } |
jburhenn | 2:445f09de09bd | 109 | if (message.getUnit(i)) { |
jburhenn | 2:445f09de09bd | 110 | printf(" unit=%s", message.getUnit(i)); |
jburhenn | 0:d20655cd1f3c | 111 | } |
jburhenn | 0:d20655cd1f3c | 112 | } |
jburhenn | 0:d20655cd1f3c | 113 | if (message.id) { |
jburhenn | 0:d20655cd1f3c | 114 | printf(" id=%s", message.id); |
jburhenn | 0:d20655cd1f3c | 115 | } |
jburhenn | 0:d20655cd1f3c | 116 | printf("\n"); |
jburhenn | 0:d20655cd1f3c | 117 | } |
jburhenn | 0:d20655cd1f3c | 118 | |
jburhenn | 0:d20655cd1f3c | 119 | /** |
jburhenn | 0:d20655cd1f3c | 120 | * Handle messages received from the Cayenne server. |
jburhenn | 0:d20655cd1f3c | 121 | * @param[in] message The message received from the Cayenne server. |
jburhenn | 0:d20655cd1f3c | 122 | */ |
jburhenn | 2:445f09de09bd | 123 | void messageArrived(CayenneMQTT::MessageData& message) |
jburhenn | 0:d20655cd1f3c | 124 | { |
jburhenn | 0:d20655cd1f3c | 125 | int error = 0; |
stiotchallenge | 8:b19f86c36974 | 126 | |
jburhenn | 0:d20655cd1f3c | 127 | // Add code to process the message. Here we just ouput the message data. |
jburhenn | 0:d20655cd1f3c | 128 | outputMessage(message); |
jburhenn | 0:d20655cd1f3c | 129 | |
jburhenn | 1:a2d8aec2bb92 | 130 | if (message.topic == COMMAND_TOPIC) { |
jburhenn | 1:a2d8aec2bb92 | 131 | switch(message.channel) { |
jburhenn | 1:a2d8aec2bb92 | 132 | case 0: |
jburhenn | 1:a2d8aec2bb92 | 133 | // Set the onboard LED state |
stiotchallenge | 8:b19f86c36974 | 134 | iotvalue = atoi(message.getValue()); |
stiotchallenge | 8:b19f86c36974 | 135 | printf("From Cayenne = %d\n",iotvalue); |
jburhenn | 1:a2d8aec2bb92 | 136 | // Publish the updated LED state |
jburhenn | 2:445f09de09bd | 137 | if ((error = mqttClient.publishData(DATA_TOPIC, message.channel, NULL, NULL, message.getValue())) != CAYENNE_SUCCESS) { |
jburhenn | 1:a2d8aec2bb92 | 138 | printf("Publish LED state failure, error: %d\n", error); |
jburhenn | 1:a2d8aec2bb92 | 139 | } |
jburhenn | 1:a2d8aec2bb92 | 140 | break; |
jburhenn | 1:a2d8aec2bb92 | 141 | } |
jburhenn | 1:a2d8aec2bb92 | 142 | |
jburhenn | 1:a2d8aec2bb92 | 143 | // If this is a command message we publish a response. Here we are just sending a default 'OK' response. |
jburhenn | 1:a2d8aec2bb92 | 144 | // An error response should be sent if there are issues processing the message. |
jburhenn | 4:939f308d004a | 145 | if ((error = mqttClient.publishResponse(message.id, NULL, message.clientID)) != CAYENNE_SUCCESS) { |
jburhenn | 1:a2d8aec2bb92 | 146 | printf("Response failure, error: %d\n", error); |
jburhenn | 1:a2d8aec2bb92 | 147 | } |
jburhenn | 0:d20655cd1f3c | 148 | } |
jburhenn | 0:d20655cd1f3c | 149 | } |
jburhenn | 0:d20655cd1f3c | 150 | |
jburhenn | 0:d20655cd1f3c | 151 | /** |
jburhenn | 0:d20655cd1f3c | 152 | * Connect to the Cayenne server. |
jburhenn | 0:d20655cd1f3c | 153 | * @return Returns CAYENNE_SUCCESS if the connection succeeds, or an error code otherwise. |
jburhenn | 0:d20655cd1f3c | 154 | */ |
jburhenn | 0:d20655cd1f3c | 155 | int connectClient(void) |
jburhenn | 0:d20655cd1f3c | 156 | { |
jburhenn | 0:d20655cd1f3c | 157 | int error = 0; |
jburhenn | 0:d20655cd1f3c | 158 | // Connect to the server. |
jburhenn | 0:d20655cd1f3c | 159 | printf("Connecting to %s:%d\n", CAYENNE_DOMAIN, CAYENNE_PORT); |
jburhenn | 0:d20655cd1f3c | 160 | while ((error = network.connect(CAYENNE_DOMAIN, CAYENNE_PORT)) != 0) { |
jburhenn | 0:d20655cd1f3c | 161 | printf("TCP connect failed, error: %d\n", error); |
jburhenn | 0:d20655cd1f3c | 162 | wait(2); |
jburhenn | 0:d20655cd1f3c | 163 | } |
jburhenn | 0:d20655cd1f3c | 164 | |
jburhenn | 2:445f09de09bd | 165 | if ((error = mqttClient.connect()) != MQTT::SUCCESS) { |
jburhenn | 0:d20655cd1f3c | 166 | printf("MQTT connect failed, error: %d\n", error); |
jburhenn | 0:d20655cd1f3c | 167 | return error; |
jburhenn | 0:d20655cd1f3c | 168 | } |
jburhenn | 0:d20655cd1f3c | 169 | printf("Connected\n"); |
jburhenn | 0:d20655cd1f3c | 170 | |
jburhenn | 0:d20655cd1f3c | 171 | // Subscribe to required topics. |
jburhenn | 0:d20655cd1f3c | 172 | if ((error = mqttClient.subscribe(COMMAND_TOPIC, CAYENNE_ALL_CHANNELS)) != CAYENNE_SUCCESS) { |
jburhenn | 0:d20655cd1f3c | 173 | printf("Subscription to Command topic failed, error: %d\n", error); |
jburhenn | 0:d20655cd1f3c | 174 | } |
jburhenn | 0:d20655cd1f3c | 175 | if ((error = mqttClient.subscribe(CONFIG_TOPIC, CAYENNE_ALL_CHANNELS)) != CAYENNE_SUCCESS) { |
jburhenn | 0:d20655cd1f3c | 176 | printf("Subscription to Config topic failed, error:%d\n", error); |
jburhenn | 0:d20655cd1f3c | 177 | } |
jburhenn | 0:d20655cd1f3c | 178 | |
jburhenn | 0:d20655cd1f3c | 179 | // Send device info. Here we just send some example values for the system info. These should be changed to use actual system data, or removed if not needed. |
jburhenn | 0:d20655cd1f3c | 180 | mqttClient.publishData(SYS_VERSION_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, CAYENNE_VERSION); |
jburhenn | 0:d20655cd1f3c | 181 | mqttClient.publishData(SYS_MODEL_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "mbedDevice"); |
jburhenn | 2:445f09de09bd | 182 | //mqttClient.publishData(SYS_CPU_MODEL_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "CPU Model"); |
jburhenn | 2:445f09de09bd | 183 | //mqttClient.publishData(SYS_CPU_SPEED_TOPIC, CAYENNE_NO_CHANNEL, NULL, NULL, "1000000000"); |
jburhenn | 0:d20655cd1f3c | 184 | |
jburhenn | 0:d20655cd1f3c | 185 | return CAYENNE_SUCCESS; |
jburhenn | 0:d20655cd1f3c | 186 | } |
jburhenn | 0:d20655cd1f3c | 187 | |
jburhenn | 0:d20655cd1f3c | 188 | /** |
jburhenn | 0:d20655cd1f3c | 189 | * Main loop where MQTT code is run. |
jburhenn | 0:d20655cd1f3c | 190 | */ |
jburhenn | 0:d20655cd1f3c | 191 | void loop(void) |
jburhenn | 0:d20655cd1f3c | 192 | { |
jburhenn | 7:78cefe0937ab | 193 | // Start the countdown timer for publishing data every 5 seconds. Change the timeout parameter to publish at a different interval. |
stiotchallenge | 12:dd98953c0a6d | 194 | MQTTTimer timer(1500); |
jburhenn | 0:d20655cd1f3c | 195 | |
jburhenn | 0:d20655cd1f3c | 196 | while (true) { |
stiotchallenge | 8:b19f86c36974 | 197 | |
jburhenn | 0:d20655cd1f3c | 198 | // Yield to allow MQTT message processing. |
jburhenn | 0:d20655cd1f3c | 199 | mqttClient.yield(1000); |
jburhenn | 0:d20655cd1f3c | 200 | |
jburhenn | 0:d20655cd1f3c | 201 | // Check that we are still connected, if not, reconnect. |
jburhenn | 0:d20655cd1f3c | 202 | if (!network.connected() || !mqttClient.connected()) { |
jburhenn | 0:d20655cd1f3c | 203 | network.disconnect(); |
jburhenn | 0:d20655cd1f3c | 204 | mqttClient.disconnect(); |
jburhenn | 0:d20655cd1f3c | 205 | printf("Reconnecting\n"); |
jburhenn | 0:d20655cd1f3c | 206 | while (connectClient() != CAYENNE_SUCCESS) { |
jburhenn | 0:d20655cd1f3c | 207 | wait(2); |
jburhenn | 0:d20655cd1f3c | 208 | printf("Reconnect failed, retrying\n"); |
jburhenn | 0:d20655cd1f3c | 209 | } |
stiotchallenge | 9:e3a211745f71 | 210 | } |
stiotchallenge | 9:e3a211745f71 | 211 | timer = myFunction (timer); |
jburhenn | 0:d20655cd1f3c | 212 | } |
jburhenn | 0:d20655cd1f3c | 213 | } |
jburhenn | 0:d20655cd1f3c | 214 | |
jburhenn | 0:d20655cd1f3c | 215 | /** |
jburhenn | 0:d20655cd1f3c | 216 | * Main function. |
jburhenn | 0:d20655cd1f3c | 217 | */ |
jburhenn | 0:d20655cd1f3c | 218 | int main() |
jburhenn | 0:d20655cd1f3c | 219 | { |
jburhenn | 0:d20655cd1f3c | 220 | // Initialize the network interface. |
jburhenn | 0:d20655cd1f3c | 221 | printf("Initializing interface\n"); |
jburhenn | 0:d20655cd1f3c | 222 | interface.connect(ssid, wifiPassword, NSAPI_SECURITY_WPA2); |
jburhenn | 0:d20655cd1f3c | 223 | |
jburhenn | 0:d20655cd1f3c | 224 | // Set the default function that receives Cayenne messages. |
jburhenn | 0:d20655cd1f3c | 225 | mqttClient.setDefaultMessageHandler(messageArrived); |
jburhenn | 0:d20655cd1f3c | 226 | |
jburhenn | 0:d20655cd1f3c | 227 | // Connect to Cayenne. |
jburhenn | 0:d20655cd1f3c | 228 | if (connectClient() == CAYENNE_SUCCESS) { |
jburhenn | 0:d20655cd1f3c | 229 | // Run main loop. |
jburhenn | 0:d20655cd1f3c | 230 | loop(); |
jburhenn | 0:d20655cd1f3c | 231 | } |
jburhenn | 0:d20655cd1f3c | 232 | else { |
jburhenn | 0:d20655cd1f3c | 233 | printf("Connection failed, exiting\n"); |
jburhenn | 0:d20655cd1f3c | 234 | } |
jburhenn | 0:d20655cd1f3c | 235 | |
jburhenn | 0:d20655cd1f3c | 236 | if (mqttClient.connected()) |
jburhenn | 0:d20655cd1f3c | 237 | mqttClient.disconnect(); |
jburhenn | 0:d20655cd1f3c | 238 | if (network.connected()) |
jburhenn | 0:d20655cd1f3c | 239 | network.disconnect(); |
jburhenn | 0:d20655cd1f3c | 240 | |
jburhenn | 0:d20655cd1f3c | 241 | return 0; |
stiotchallenge | 9:e3a211745f71 | 242 | } |