Emilija Stankovic / Mbed OS PMK_industrija_mikro2

PMKIND

Dependencies:   Servo TextLCD

main.cpp@2:5918b8bad3a7, 2021-07-05 (annotated)

Committer:
emilija
Date:
Mon Jul 05 12:56:18 2021 +0000
Revision:
2:5918b8bad3a7
Parent:
1:d3bb978c1ff7 
PMK_INDUSTRIJA_MICRO2 VERZIJA2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
emilija 0:51001d8fdeff 1 /* mbed Microcontroller Library
emilija 0:51001d8fdeff 2 * Copyright (c) 2019 ARM Limited
emilija 0:51001d8fdeff 3 * SPDX-License-Identifier: Apache-2.0
emilija 0:51001d8fdeff 4 */
emilija 0:51001d8fdeff 5
emilija 0:51001d8fdeff 6 #include "mbed.h"
emilija 0:51001d8fdeff 7 #include "platform/mbed_thread.h"
emilija 0:51001d8fdeff 8 #include "Servo.h"
emilija 0:51001d8fdeff 9 #include "color.h"
emilija 0:51001d8fdeff 10 #include <string>
emilija 0:51001d8fdeff 11 #include <MQTTClientMbedOs.h>
emilija 1:d3bb978c1ff7 12 #include <algorithm>
emilija 0:51001d8fdeff 13
emilija 0:51001d8fdeff 14 // Blinking rate in milliseconds
emilija 0:51001d8fdeff 15 #define BLINKING_RATE_MS 500
emilija 0:51001d8fdeff 16
emilija 2:5918b8bad3a7 17 // varijable za boju
emilija 2:5918b8bad3a7 18
emilija 1:d3bb978c1ff7 19 float r1[3]={1 ,109.0/399.0,133.0/399.0};
emilija 1:d3bb978c1ff7 20 float g1[3]={206.0/411.0,399.0/411.0,1};
emilija 1:d3bb978c1ff7 21 float b1[3]={120.0/490.0 ,209.0/490.0, 1};
emilija 2:5918b8bad3a7 22 DigitalOut colorLed(D4);
emilija 2:5918b8bad3a7 23 DigitalOut colorVout(D5);
emilija 2:5918b8bad3a7 24 int salji_boju=0;
emilija 2:5918b8bad3a7 25 int fleg_start=0;
emilija 2:5918b8bad3a7 26 Serial pc(USBTX,USBRX);
emilija 2:5918b8bad3a7 27 // varijable za servo
emilija 0:51001d8fdeff 28 Servo servo0(D3);
emilija 1:d3bb978c1ff7 29 Servo servo1(D6);
emilija 1:d3bb978c1ff7 30 DigitalOut Servo1Napajanje(D7);
emilija 2:5918b8bad3a7 31
emilija 0:51001d8fdeff 32 InterruptIn button(USER_BUTTON);
emilija 0:51001d8fdeff 33 int arrivedcount = 0;
emilija 0:51001d8fdeff 34 TCPSocket socket;
emilija 0:51001d8fdeff 35 MQTTClient client(&socket);
emilija 0:51001d8fdeff 36 MQTT::Message message;
emilija 0:51001d8fdeff 37 int button_pressed=0;
emilija 2:5918b8bad3a7 38
emilija 2:5918b8bad3a7 39 //Timeout T1;
emilija 2:5918b8bad3a7 40 //void interruptT1(){
emilija 2:5918b8bad3a7 41 // printf("error1");
emilija 2:5918b8bad3a7 42 // }
emilija 2:5918b8bad3a7 43
emilija 2:5918b8bad3a7 44 char* topic_pub = "PMK_industrija/micro1/color1";
emilija 2:5918b8bad3a7 45 char* topic_pub1 = "PMK_industrija/micro1/echo/2";
emilija 0:51001d8fdeff 46 char* topic_sub = "PMK_industrija/micro2/#";
emilija 2:5918b8bad3a7 47
emilija 0:51001d8fdeff 48
emilija 0:51001d8fdeff 49 WiFiInterface *wifi;
emilija 0:51001d8fdeff 50 volatile int mems_event = 0;
emilija 0:51001d8fdeff 51 uint32_t previous_tick = 0;
emilija 0:51001d8fdeff 52 uint32_t current_tick = 0;
emilija 0:51001d8fdeff 53 uint8_t high = 0, low = 0;
emilija 0:51001d8fdeff 54 float temperature = 0.0f;
emilija 0:51001d8fdeff 55 char buffer[32];
emilija 2:5918b8bad3a7 56
emilija 0:51001d8fdeff 57 static char *print_double(char *str, double v, int decimalDigits = 2)
emilija 0:51001d8fdeff 58 {
emilija 0:51001d8fdeff 59 int i = 1;
emilija 0:51001d8fdeff 60 int intPart, fractPart;
emilija 0:51001d8fdeff 61 int len;
emilija 0:51001d8fdeff 62 char *ptr;
emilija 0:51001d8fdeff 63
emilija 0:51001d8fdeff 64 /* prepare decimal digits multiplicator */
emilija 0:51001d8fdeff 65 for (; decimalDigits != 0; i *= 10, decimalDigits--);
emilija 0:51001d8fdeff 66
emilija 0:51001d8fdeff 67 /* calculate integer & fractinal parts */
emilija 0:51001d8fdeff 68 intPart = (int)v;
emilija 0:51001d8fdeff 69 fractPart = (int)((v - (double)(int)v) * i);
emilija 0:51001d8fdeff 70
emilija 0:51001d8fdeff 71 /* fill in integer part */
emilija 0:51001d8fdeff 72 sprintf(str, "%i.", intPart);
emilija 0:51001d8fdeff 73
emilija 0:51001d8fdeff 74 /* prepare fill in of fractional part */
emilija 0:51001d8fdeff 75 len = strlen(str);
emilija 0:51001d8fdeff 76 ptr = &str[len];
emilija 0:51001d8fdeff 77
emilija 0:51001d8fdeff 78 /* fill in leading fractional zeros */
emilija 0:51001d8fdeff 79 for (i /= 10; i > 1; i /= 10, ptr++) {
emilija 0:51001d8fdeff 80 if (fractPart >= i) {
emilija 0:51001d8fdeff 81 break;
emilija 0:51001d8fdeff 82 }
emilija 0:51001d8fdeff 83 *ptr = '0';
emilija 0:51001d8fdeff 84 }
emilija 0:51001d8fdeff 85
emilija 0:51001d8fdeff 86 /* fill in (rest of) fractional part */
emilija 0:51001d8fdeff 87 sprintf(ptr, "%i", fractPart);
emilija 0:51001d8fdeff 88
emilija 0:51001d8fdeff 89 return str;
emilija 0:51001d8fdeff 90 }
emilija 0:51001d8fdeff 91
emilija 0:51001d8fdeff 92 const char *sec2str(nsapi_security_t sec)
emilija 0:51001d8fdeff 93 {
emilija 0:51001d8fdeff 94 switch (sec) {
emilija 0:51001d8fdeff 95 case NSAPI_SECURITY_NONE:
emilija 0:51001d8fdeff 96 return "None";
emilija 0:51001d8fdeff 97 case NSAPI_SECURITY_WEP:
emilija 0:51001d8fdeff 98 return "WEP";
emilija 0:51001d8fdeff 99 case NSAPI_SECURITY_WPA:
emilija 0:51001d8fdeff 100 return "WPA";
emilija 0:51001d8fdeff 101 case NSAPI_SECURITY_WPA2:
emilija 0:51001d8fdeff 102 return "WPA2";
emilija 0:51001d8fdeff 103 case NSAPI_SECURITY_WPA_WPA2:
emilija 0:51001d8fdeff 104 return "WPA/WPA2";
emilija 0:51001d8fdeff 105 case NSAPI_SECURITY_UNKNOWN:
emilija 0:51001d8fdeff 106 default:
emilija 0:51001d8fdeff 107 return "Unknown";
emilija 0:51001d8fdeff 108 }
emilija 0:51001d8fdeff 109 }
emilija 0:51001d8fdeff 110
emilija 0:51001d8fdeff 111 int scan_demo(WiFiInterface *wifi)
emilija 0:51001d8fdeff 112 {
emilija 0:51001d8fdeff 113 WiFiAccessPoint *ap;
emilija 0:51001d8fdeff 114 printf("Scan:\n");
emilija 0:51001d8fdeff 115 int count = wifi->scan(NULL,0);
emilija 0:51001d8fdeff 116 if (count <= 0) {
emilija 0:51001d8fdeff 117 printf("scan() failed with return value: %d\n", count);
emilija 0:51001d8fdeff 118 return 0;
emilija 0:51001d8fdeff 119 }
emilija 0:51001d8fdeff 120 /* Limit number of network arbitrary to 15 */
emilija 0:51001d8fdeff 121 count = count < 15 ? count : 15;
emilija 0:51001d8fdeff 122 ap = new WiFiAccessPoint[count];
emilija 0:51001d8fdeff 123 count = wifi->scan(ap, count);
emilija 0:51001d8fdeff 124 if (count <= 0) {
emilija 0:51001d8fdeff 125 printf("scan() failed with return value: %d\n", count);
emilija 0:51001d8fdeff 126 return 0;
emilija 0:51001d8fdeff 127 }
emilija 0:51001d8fdeff 128 for (int i = 0; i < count; i++) {
emilija 0:51001d8fdeff 129 printf("Network: %s secured: %s BSSID: %hhX:%hhX:%hhX:%hhx:%hhx:%hhx RSSI: %hhd Ch: %hhd\n", ap[i].get_ssid(),
emilija 0:51001d8fdeff 130 sec2str(ap[i].get_security()), ap[i].get_bssid()[0], ap[i].get_bssid()[1], ap[i].get_bssid()[2],
emilija 0:51001d8fdeff 131 ap[i].get_bssid()[3], ap[i].get_bssid()[4], ap[i].get_bssid()[5], ap[i].get_rssi(), ap[i].get_channel());
emilija 0:51001d8fdeff 132 }
emilija 0:51001d8fdeff 133 printf("%d networks available.\n", count);
emilija 0:51001d8fdeff 134 delete[] ap;
emilija 0:51001d8fdeff 135 return count;
emilija 0:51001d8fdeff 136 }
emilija 0:51001d8fdeff 137
emilija 0:51001d8fdeff 138 void messageArrived(MQTT::MessageData& md)
emilija 2:5918b8bad3a7 139 { char buf[100];
emilija 0:51001d8fdeff 140 MQTTString &topic = md.topicName;
emilija 0:51001d8fdeff 141 string topic_name = topic.lenstring.data;
emilija 0:51001d8fdeff 142 printf("Topic name %d : %s\r\n",topic.lenstring.len,topic_name.c_str() );
emilija 0:51001d8fdeff 143 MQTT::Message &message = md.message;
emilija 0:51001d8fdeff 144 printf("Message arrived: qos %d, retained %d, dup %d, packetid %d\r\n", message.qos, message.retained, message.dup, message.id);
emilija 0:51001d8fdeff 145 printf("Payload %.*s\r\n", message.payloadlen, (char*)message.payload);
emilija 2:5918b8bad3a7 146 string poruka = (char*)message.payload;
emilija 2:5918b8bad3a7 147
emilija 2:5918b8bad3a7 148 //if(topic_name.find("servo0")!=std::string::npos) {
emilija 2:5918b8bad3a7 149 // printf("AKTIVIRAN SERVO0\n");
emilija 2:5918b8bad3a7 150 // for(float p=0; p<1.0; p += 0.1) {
emilija 2:5918b8bad3a7 151 // servo0 = p;
emilija 0:51001d8fdeff 152
emilija 2:5918b8bad3a7 153 // }
emilija 2:5918b8bad3a7 154 // wait(2);
emilija 2:5918b8bad3a7 155 // for(float p=1.0; p>0.0; p -= 0.1) {
emilija 2:5918b8bad3a7 156 // servo0 = p;
emilija 2:5918b8bad3a7 157
emilija 2:5918b8bad3a7 158 //}
emilija 0:51001d8fdeff 159
emilija 2:5918b8bad3a7 160 //sprintf(buf, "servo0-AKTIVIRAN \r\n");
emilija 2:5918b8bad3a7 161 // message.qos = MQTT::QOS0;
emilija 2:5918b8bad3a7 162 //message.retained = false;
emilija 2:5918b8bad3a7 163 //message.dup = false;
emilija 2:5918b8bad3a7 164 //message.payload = (void*)buf;
emilija 2:5918b8bad3a7 165 //message.payloadlen = strlen(buf)+1;
emilija 2:5918b8bad3a7 166 //client.publish(topic_pub1, message);
emilija 2:5918b8bad3a7 167 //}
emilija 2:5918b8bad3a7 168 //else if(topic_name.find("color1")!=std::string::npos){
emilija 2:5918b8bad3a7 169 //salji_boju=1;
emilija 2:5918b8bad3a7 170 //}
emilija 2:5918b8bad3a7 171 //else if(topic_name.find("servo1")!=std::string::npos){
emilija 2:5918b8bad3a7 172 // T1.detach();
emilija 2:5918b8bad3a7 173 // printf("AKTIVIRAN SERVO1\n");
emilija 2:5918b8bad3a7 174 // for(float p=0; p<1.0; p += 0.1) {
emilija 2:5918b8bad3a7 175 //servo1 = p;
emilija 2:5918b8bad3a7 176 // da li na 45
emilija 2:5918b8bad3a7 177 //}
emilija 2:5918b8bad3a7 178 //wait(2);
emilija 2:5918b8bad3a7 179 //for(float p=1.0; p>0.0; p -= 0.1) {
emilija 2:5918b8bad3a7 180 //servo1 = p;
emilija 2:5918b8bad3a7 181
emilija 2:5918b8bad3a7 182 //}
emilija 1:d3bb978c1ff7 183
emilija 2:5918b8bad3a7 184 // sprintf(buf, "servo1-AKTIVIRAN \r\n");
emilija 2:5918b8bad3a7 185 //message.qos = MQTT::QOS0;
emilija 2:5918b8bad3a7 186 //message.retained = false;
emilija 2:5918b8bad3a7 187 //message.dup = false;
emilija 2:5918b8bad3a7 188 //message.payload = (void*)buf;
emilija 2:5918b8bad3a7 189 //message.payloadlen = strlen(buf)+1;
emilija 2:5918b8bad3a7 190 //client.publish(topic_pub1, message);
emilija 2:5918b8bad3a7 191
emilija 1:d3bb978c1ff7 192
emilija 2:5918b8bad3a7 193 //}
emilija 2:5918b8bad3a7 194 //else
emilija 2:5918b8bad3a7 195 if(topic_name.find("echo")!=std::string::npos){
emilija 2:5918b8bad3a7 196 if(poruka.find("connect")!=std::string::npos){
emilija 2:5918b8bad3a7 197 fleg_start=1;
emilija 2:5918b8bad3a7 198 sprintf(buf, "echo2 \r\n");
emilija 2:5918b8bad3a7 199 message.qos = MQTT::QOS0;
emilija 2:5918b8bad3a7 200 message.retained = false;
emilija 2:5918b8bad3a7 201 message.dup = false;
emilija 2:5918b8bad3a7 202 message.payload = (void*)buf;
emilija 2:5918b8bad3a7 203 message.payloadlen = strlen(buf)+1;
emilija 2:5918b8bad3a7 204 client.publish(topic_pub1, message);
emilija 2:5918b8bad3a7 205 }
emilija 2:5918b8bad3a7 206 else if(poruka.find("echo")!=std::string::npos){
emilija 2:5918b8bad3a7 207 // T1.detach();
emilija 2:5918b8bad3a7 208 }
emilija 2:5918b8bad3a7 209 }
emilija 0:51001d8fdeff 210 ++arrivedcount;
emilija 2:5918b8bad3a7 211
emilija 0:51001d8fdeff 212 }
emilija 0:51001d8fdeff 213
emilija 0:51001d8fdeff 214
emilija 0:51001d8fdeff 215 void buttonFunction() {
emilija 0:51001d8fdeff 216 button_pressed=1;
emilija 0:51001d8fdeff 217 }
emilija 0:51001d8fdeff 218
emilija 0:51001d8fdeff 219 int main()
emilija 2:5918b8bad3a7 220 {
emilija 0:51001d8fdeff 221 // Initialise the digital pin LED1 as an output
emilija 1:d3bb978c1ff7 222 colorLed=1;
emilija 1:d3bb978c1ff7 223 colorVout=1;
emilija 2:5918b8bad3a7 224
emilija 0:51001d8fdeff 225 ColorSensor cs(PA_5,PA_6,PA_7,PB_6,PC_7);
emilija 0:51001d8fdeff 226 DigitalOut led(LED1);
emilija 2:5918b8bad3a7 227 Servo1Napajanje=1;
emilija 0:51001d8fdeff 228 servo0.calibrate(0.0005,90);
emilija 1:d3bb978c1ff7 229 servo1.calibrate(0.0005,180);
emilija 0:51001d8fdeff 230 button.rise(&buttonFunction);
emilija 2:5918b8bad3a7 231
emilija 0:51001d8fdeff 232 const char* hostname = "broker.mqttdashboard.com";
emilija 0:51001d8fdeff 233 int port = 1883;
emilija 0:51001d8fdeff 234 wifi = WiFiInterface::get_default_instance();
emilija 0:51001d8fdeff 235 if (!wifi) {
emilija 0:51001d8fdeff 236 printf("ERROR: No WiFiInterface found.\n");
emilija 0:51001d8fdeff 237 return -1;
emilija 0:51001d8fdeff 238 }
emilija 0:51001d8fdeff 239
emilija 0:51001d8fdeff 240 int count = scan_demo(wifi);
emilija 0:51001d8fdeff 241 if (count == 0) {
emilija 0:51001d8fdeff 242 printf("No WIFI APs found - can't continue further.\n");
emilija 0:51001d8fdeff 243 return -1;
emilija 0:51001d8fdeff 244 }
emilija 0:51001d8fdeff 245
emilija 0:51001d8fdeff 246 printf("\nConnecting to %s...\n", MBED_CONF_APP_WIFI_SSID);
emilija 0:51001d8fdeff 247 int ret = wifi->connect(MBED_CONF_APP_WIFI_SSID, MBED_CONF_APP_WIFI_PASSWORD, NSAPI_SECURITY_WPA_WPA2);
emilija 0:51001d8fdeff 248 if (ret != 0) {
emilija 0:51001d8fdeff 249 printf("\nConnection error: %d\n", ret);
emilija 0:51001d8fdeff 250 return -1;
emilija 0:51001d8fdeff 251 }
emilija 0:51001d8fdeff 252
emilija 0:51001d8fdeff 253 printf("Success\n\n");
emilija 0:51001d8fdeff 254 printf("MAC: %s\n", wifi->get_mac_address());
emilija 0:51001d8fdeff 255 printf("IP: %s\n", wifi->get_ip_address());
emilija 0:51001d8fdeff 256 printf("Netmask: %s\n", wifi->get_netmask());
emilija 0:51001d8fdeff 257 printf("Gateway: %s\n", wifi->get_gateway());
emilija 0:51001d8fdeff 258 printf("RSSI: %d\n\n", wifi->get_rssi());
emilija 0:51001d8fdeff 259
emilija 0:51001d8fdeff 260 socket.open(wifi);
emilija 0:51001d8fdeff 261 socket.connect(hostname, port);
emilija 0:51001d8fdeff 262
emilija 0:51001d8fdeff 263 int rc=0;
emilija 0:51001d8fdeff 264
emilija 0:51001d8fdeff 265 MQTTPacket_connectData data = MQTTPacket_connectData_initializer;
emilija 0:51001d8fdeff 266 data.MQTTVersion = 3;
emilija 0:51001d8fdeff 267 data.clientID.cstring = "PMK-client2";
emilija 0:51001d8fdeff 268 //data.username.cstring = "testuser";
emilija 0:51001d8fdeff 269 //data.password.cstring = "testpassword";
emilija 0:51001d8fdeff 270
emilija 0:51001d8fdeff 271 if ((rc = client.connect(data)) != 0)
emilija 0:51001d8fdeff 272 printf("rc from MQTT connect is %d\r\n", rc);
emilija 0:51001d8fdeff 273
emilija 0:51001d8fdeff 274
emilija 0:51001d8fdeff 275 if ((rc = client.subscribe(topic_sub, MQTT::QOS2, messageArrived)) != 0)
emilija 0:51001d8fdeff 276 printf("rc from MQTT subscribe is %d\r\n", rc);
emilija 0:51001d8fdeff 277
emilija 0:51001d8fdeff 278
emilija 2:5918b8bad3a7 279 char buf[100];
emilija 2:5918b8bad3a7 280 float treshold=0.1;
emilija 0:51001d8fdeff 281 while (true) {
emilija 2:5918b8bad3a7 282 client.yield(1000);
emilija 2:5918b8bad3a7 283 if (fleg_start==1){
emilija 0:51001d8fdeff 284 led = !led;
emilija 0:51001d8fdeff 285 thread_sleep_for(BLINKING_RATE_MS);
emilija 1:d3bb978c1ff7 286 if (salji_boju==1) {
emilija 1:d3bb978c1ff7 287 salji_boju=0;
emilija 0:51001d8fdeff 288 printf("Publishing data\r\n");
emilija 0:51001d8fdeff 289 // QoS 0
emilija 2:5918b8bad3a7 290
emilija 1:d3bb978c1ff7 291
emilija 1:d3bb978c1ff7 292 int Boja[3]={cs.getRed(), cs.getGreen(),cs.getBlue()};
emilija 0:51001d8fdeff 293
emilija 1:d3bb978c1ff7 294 while(Boja[0]<30 && Boja[1]<30 && Boja[2]<30){
emilija 1:d3bb978c1ff7 295 wait(1);
emilija 1:d3bb978c1ff7 296 Boja[0]=cs.getRed();
emilija 1:d3bb978c1ff7 297 Boja[1]=cs.getGreen();
emilija 1:d3bb978c1ff7 298 Boja[2]=cs.getBlue();
emilija 1:d3bb978c1ff7 299 printf("LOSE MERENJE \r\n");
emilija 1:d3bb978c1ff7 300 printf("R:%d , G:%d , B:%d",Boja[0],Boja[1],Boja[2]);
emilija 1:d3bb978c1ff7 301 }
emilija 1:d3bb978c1ff7 302 int strongCol=max(Boja[0],max(Boja[1],Boja[2]));
emilija 1:d3bb978c1ff7 303 float BojaScal[3];
emilija 1:d3bb978c1ff7 304 BojaScal[0]=Boja[0]/(strongCol*1.0);
emilija 1:d3bb978c1ff7 305 BojaScal[1]=Boja[1]/(strongCol*1.0);
emilija 1:d3bb978c1ff7 306 BojaScal[2]=Boja[2]/(strongCol*1.0);
emilija 1:d3bb978c1ff7 307
emilija 1:d3bb978c1ff7 308 if(BojaScal[1]<r1[1]+treshold && BojaScal[1]>r1[1]-treshold && BojaScal[2]<r1[2]+treshold && BojaScal[0]>r1[0]-treshold && BojaScal[0]<r1[0]+treshold && BojaScal[2]>r1[2]-treshold ) {
emilija 2:5918b8bad3a7 309 sprintf(buf, "Jeste \r\n");}
emilija 1:d3bb978c1ff7 310 else if(BojaScal[1]<g1[1]+treshold && BojaScal[1]>g1[1]-treshold && BojaScal[2]<g1[2]+treshold && BojaScal[0]>g1[0]-treshold && BojaScal[0]<g1[0]+treshold && BojaScal[2]>g1[2]-treshold ) {
emilija 2:5918b8bad3a7 311 sprintf(buf, "Nije \r\n");}
emilija 1:d3bb978c1ff7 312 else if(BojaScal[1]<b1[1]+treshold && BojaScal[1]>b1[1]-treshold && BojaScal[2]<b1[2]+treshold && BojaScal[0]>b1[0]-treshold && BojaScal[0]<b1[0]+treshold && BojaScal[2]>b1[2]-treshold ) {
emilija 2:5918b8bad3a7 313 sprintf(buf, "Nije \r\n");}
emilija 2:5918b8bad3a7 314 else { sprintf(buf, "Nije \r\n");}
emilija 1:d3bb978c1ff7 315
emilija 1:d3bb978c1ff7 316 printf("R: %.3f", BojaScal[0]);
emilija 1:d3bb978c1ff7 317 printf("G: %.3f", BojaScal[1]);
emilija 1:d3bb978c1ff7 318 printf("B: %.3f\r\n", BojaScal[2]);
emilija 1:d3bb978c1ff7 319
emilija 1:d3bb978c1ff7 320 printf(" Crvena R: %.3f", r1[0]);
emilija 1:d3bb978c1ff7 321 printf("G: %.3f", r1[1]);
emilija 1:d3bb978c1ff7 322 printf("B: %.3f\r\n", r1[2]);
emilija 1:d3bb978c1ff7 323
emilija 0:51001d8fdeff 324 //sprintf(buf, "RGB: %7s C\r\n", print_double(buffer, cs.getRed()*100000000+cs.getGreen()*10000+cs.getBlue()));
emilija 0:51001d8fdeff 325
emilija 1:d3bb978c1ff7 326 message.qos = MQTT::QOS0;
emilija 1:d3bb978c1ff7 327 message.retained = false;
emilija 1:d3bb978c1ff7 328 message.dup = false;
emilija 1:d3bb978c1ff7 329 message.payload = (void*)buf;
emilija 1:d3bb978c1ff7 330 message.payloadlen = strlen(buf)+1;
emilija 1:d3bb978c1ff7 331 client.publish(topic_pub, message);
emilija 2:5918b8bad3a7 332 // T1.attach(&interruptT1,5);
emilija 0:51001d8fdeff 333 }
emilija 1:d3bb978c1ff7 334 //printf("Yielding");
emilija 0:51001d8fdeff 335 client.yield(1000);
emilija 1:d3bb978c1ff7 336 //printf(" -> Yielded\r\n");
emilija 0:51001d8fdeff 337 }
emilija 2:5918b8bad3a7 338 }
emilija 2:5918b8bad3a7 339
emilija 0:51001d8fdeff 340 }