Emilija Stankovic / Mbed OS PMK_industrija_mikro4

PMK_industrija_mikro4

Dependencies:   rohm-rpr0521 rohm-sensor-hal Servo TextLCD

main.cpp@0:c4a5143aeebc, 2021-06-30 (annotated)

Committer:
emilija
Date:
Wed Jun 30 20:52:55 2021 +0000
Revision:
0:c4a5143aeebc
Child:
1:c49ad58c141d
PMK_industrija_mikro4

Who changed what in which revision?

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