Chau Vo / Mbed 2 deprecated F103-Web-Server

Webserver only w/o any other functions, single thread. Running on STM32F013+W5500

Dependencies:   NTPClient W5500Interface Watchdog device_configuration eeprom_flash mbed-rpc-nucleo mbed-rtos mbed

Fork of F103-Serial-to-Ethernet by Chau Vo

main.cpp@23:47ee805435b1, 2014-11-27 (annotated)

Committer:
olympux
Date:
Thu Nov 27 18:01:15 2014 +0000
Revision:
23:47ee805435b1
Parent:
22:e5f0aa929c44
Child:
24:ca0199b8a3aa
Update checking a package received through UDP is a configuration command or data

Who changed what in which revision?

UserRevisionLine numberNew contents of line
olympux 0:c2eac797face 1 /*
olympux 0:c2eac797face 2 *
olympux 2:18f10e7209f4 3 * Alarm and Monitoring application
olympux 0:c2eac797face 4 */
olympux 0:c2eac797face 5 #include "mbed.h"
olympux 12:7c152c0ca4d8 6 #include "eeprom.h"
olympux 0:c2eac797face 7 #include "EthernetInterface.h"
olympux 9:d2534ecf88c6 8 #include "NTPClient.h"
olympux 0:c2eac797face 9 #include "rtos.h"
olympux 0:c2eac797face 10
olympux 12:7c152c0ca4d8 11 #include "my_eeprom_funcs.h"
olympux 20:71c7950fdd91 12 #include "Watchdog.h"
olympux 12:7c152c0ca4d8 13
olympux 0:c2eac797face 14
olympux 16:84a5bf7285d0 15 //Debug is disabled by default
olympux 16:84a5bf7285d0 16 #if 1
olympux 16:84a5bf7285d0 17 //Enable debug
olympux 16:84a5bf7285d0 18 #include <cstdio>
olympux 16:84a5bf7285d0 19 #define DBG(x, ...) std::printf("[main : DBG]"x"\r\n", ##__VA_ARGS__);
olympux 16:84a5bf7285d0 20 #define WARN(x, ...) std::printf("[main : WARN]"x"\r\n", ##__VA_ARGS__);
olympux 16:84a5bf7285d0 21 #define ERR(x, ...) std::printf("[main : ERR]"x"\r\n", ##__VA_ARGS__);
olympux 16:84a5bf7285d0 22
olympux 16:84a5bf7285d0 23 #else
olympux 16:84a5bf7285d0 24 //Disable debug
olympux 16:84a5bf7285d0 25 #define DBG(x, ...)
olympux 16:84a5bf7285d0 26 #define WARN(x, ...)
olympux 16:84a5bf7285d0 27 #define ERR(x, ...)
olympux 16:84a5bf7285d0 28
olympux 16:84a5bf7285d0 29 #endif
olympux 16:84a5bf7285d0 30
olympux 16:84a5bf7285d0 31
olympux 2:18f10e7209f4 32 /*
olympux 2:18f10e7209f4 33 * Hardware defines
olympux 0:c2eac797face 34 */
olympux 2:18f10e7209f4 35 #define ST_NUCLEO // hardware pin mapping
olympux 0:c2eac797face 36
olympux 0:c2eac797face 37 #ifdef ST_NUCLEO
olympux 9:d2534ecf88c6 38 // Ethernet
olympux 0:c2eac797face 39 SPI spi(PA_7, PA_6, PA_5); // mosi, miso, sclk
olympux 11:709f90a3b599 40 EthernetInterface eth(&spi, PA_4, PC_9); // spi, cs, reset
olympux 0:c2eac797face 41 #endif
olympux 0:c2eac797face 42
olympux 9:d2534ecf88c6 43 // Serial
olympux 2:18f10e7209f4 44 Serial uart(USBTX,USBRX);
olympux 2:18f10e7209f4 45
olympux 9:d2534ecf88c6 46 // Digital inputs
olympux 11:709f90a3b599 47 DigitalIn din0(PB_14);
olympux 11:709f90a3b599 48 DigitalIn din1(PB_12);
olympux 11:709f90a3b599 49 DigitalIn din2(PB_10);
olympux 11:709f90a3b599 50 DigitalIn din3(PB_1);
olympux 11:709f90a3b599 51 DigitalIn din4(PB_15);
olympux 11:709f90a3b599 52 DigitalIn din5(PB_13);
olympux 11:709f90a3b599 53 DigitalIn din6(PB_11);
olympux 11:709f90a3b599 54 DigitalIn din7(PB_2);
olympux 9:d2534ecf88c6 55 // Digital outputs
olympux 11:709f90a3b599 56 DigitalOut dout0(PB_3);
olympux 11:709f90a3b599 57 DigitalOut dout1(PB_5);
olympux 11:709f90a3b599 58 DigitalOut dout2(PB_7);
olympux 11:709f90a3b599 59 DigitalOut dout3(PB_9);
olympux 11:709f90a3b599 60 DigitalOut dout4(PD_2);
olympux 11:709f90a3b599 61 DigitalOut dout5(PB_4);
olympux 11:709f90a3b599 62 DigitalOut dout6(PB_6);
olympux 11:709f90a3b599 63 DigitalOut dout7(PB_8);
olympux 9:d2534ecf88c6 64 // Analog inputs
olympux 11:709f90a3b599 65 AnalogIn ain0(PC_0);
olympux 11:709f90a3b599 66 AnalogIn ain1(PC_1);
olympux 9:d2534ecf88c6 67 // Analog outputs
olympux 11:709f90a3b599 68 //AnalogOut ano0(PA_8);
olympux 11:709f90a3b599 69 //AnalogOut ano1(PA_15);
olympux 11:709f90a3b599 70
olympux 20:71c7950fdd91 71 // Watchdog
olympux 20:71c7950fdd91 72 Watchdog wdt;
olympux 20:71c7950fdd91 73
olympux 20:71c7950fdd91 74
olympux 12:7c152c0ca4d8 75 void update_digital_outputs(char* buf);
olympux 12:7c152c0ca4d8 76 void update_sending_frame(char* buf);
olympux 11:709f90a3b599 77
olympux 9:d2534ecf88c6 78
olympux 9:d2534ecf88c6 79
olympux 13:bcf840da68fd 80 /*
olympux 13:bcf840da68fd 81 * EEPROM section
olympux 13:bcf840da68fd 82 */
olympux 6:d054e394fba3 83 // Virtual address defined by the user: 0xFFFF value is prohibited
olympux 6:d054e394fba3 84 uint16_t VirtAddVarTab[NumbOfVar] = {0x1212, 0x1313, 0x1414, 0x1515, // IP_Addr
olympux 6:d054e394fba3 85 0x2212, 0x2313, 0x2414, 0x2515, // IP_Subnet
olympux 6:d054e394fba3 86 0x3212, 0x3313, 0x3414, 0x3515, // IP_Gateway
olympux 6:d054e394fba3 87 0x4212, // TCP server port, not used
olympux 8:64848959adb9 88 0x5212, // UDP server port, not used
olympux 16:84a5bf7285d0 89 0x8888, // 1st run? 0xA5A5 = configured
olympux 12:7c152c0ca4d8 90 0x6212, 0x6313, 0x6414, // MAC
olympux 12:7c152c0ca4d8 91
olympux 12:7c152c0ca4d8 92 // this section is for the TCP server that this device connects to in TCP client mode
olympux 16:84a5bf7285d0 93 0x7212, 0x7313, // 0xA5 = auto transmit status, time period
olympux 12:7c152c0ca4d8 94 0x8212, 0x8313,0x8414, 0x8515, // TCP server IP address
olympux 16:84a5bf7285d0 95 0x9212, // TCP server port
olympux 16:84a5bf7285d0 96
olympux 16:84a5bf7285d0 97 // this section is for selecting protocol
olympux 16:84a5bf7285d0 98 0xA212, // 0xA5A5 = enable TCP server
olympux 16:84a5bf7285d0 99 0xA313, // 0xA5A5 = eanble TCP client
olympux 18:ca499a2e7da6 100 0xA414 // 0xA5A5 = enable UDP server
olympux 6:d054e394fba3 101 };
olympux 0:c2eac797face 102
olympux 2:18f10e7209f4 103 /*
olympux 2:18f10e7209f4 104 * Network configuration
olympux 2:18f10e7209f4 105 */
olympux 4:568c97f2a407 106 #define TCP_SERVER
olympux 15:edeb0aed160d 107 #define TCP_CLIENT
olympux 4:568c97f2a407 108 #define UDP_SERVER
olympux 4:568c97f2a407 109 //#define UDP_CLIENT
olympux 10:4cd965d79de0 110 #define NTP
olympux 4:568c97f2a407 111
olympux 20:71c7950fdd91 112 #define TCP_SERVER_WAIT_CLIENT_TIMEOUT 200 // timeout for local tcp server wait for a remote client
olympux 20:71c7950fdd91 113 #define TCP_SERVER_RECEIVE_TIMEOUT 2000 // timeout for local tcp server wait to receive from remote client
olympux 20:71c7950fdd91 114 #define TCP_CLIENT_RECEIVE_TIMEOUT 200 // timeout for local tcp client try to connect remote server
olympux 20:71c7950fdd91 115 #define UDP_SERVER_RECEIVE_TIMEOUT 100 // timeout for checking config command
olympux 4:568c97f2a407 116
olympux 15:edeb0aed160d 117
olympux 15:edeb0aed160d 118 // TCP server function
olympux 15:edeb0aed160d 119 TCPSocketServer tcp_server;
olympux 15:edeb0aed160d 120 TCPSocketConnection tcp_client;
olympux 15:edeb0aed160d 121 // TCP client function
olympux 15:edeb0aed160d 122 TCPSocketConnection tcp_sock;
olympux 15:edeb0aed160d 123 // UDP server
olympux 15:edeb0aed160d 124 UDPSocket udp_server;
olympux 15:edeb0aed160d 125 Endpoint ep_udp_client;
olympux 15:edeb0aed160d 126 // NTP
olympux 13:bcf840da68fd 127 NTPClient ntp;
olympux 13:bcf840da68fd 128
olympux 13:bcf840da68fd 129
olympux 15:edeb0aed160d 130
olympux 13:bcf840da68fd 131 /*
olympux 13:bcf840da68fd 132 * Variables for network configuration, server
olympux 13:bcf840da68fd 133 */
olympux 11:709f90a3b599 134 uint8_t u8mac[6], u8ip_addr[4];// keep mac and ip address in 8-bits
olympux 11:709f90a3b599 135 uint16_t u16mac_addr[3], u16ip_addr[4], u16ip_subnet[4], u16ip_gateway[4]; // 16-bits, directly loaded from eeprom
olympux 11:709f90a3b599 136 char str_ip_addr[16], str_ip_subnet[16], str_ip_gateway[16]; // for printf, converted from 16-bits u16ip_xxx
olympux 9:d2534ecf88c6 137 uint16_t first_run = 0; // first run flag
olympux 9:d2534ecf88c6 138
olympux 22:e5f0aa929c44 139 const uint16_t tcp_server_local_port = 10000; // fixed, change to 7000 if internet required
olympux 12:7c152c0ca4d8 140 const uint16_t udp_server_local_port = 11000; // fixed
olympux 12:7c152c0ca4d8 141
olympux 12:7c152c0ca4d8 142 // TCP client: this section is used for the TCP server that this device connects to in TCP client mode
olympux 12:7c152c0ca4d8 143 // this device will transmit status every transmit_time_period
olympux 12:7c152c0ca4d8 144 uint16_t auto_transmit_flag = 0, transmit_time_period = 1000; // auto transmit status, time period = 1s
olympux 12:7c152c0ca4d8 145 uint16_t u16server_ip_addr[4]; // directly loaded from eeprom
olympux 14:18eda020a589 146 uint8_t u8server_ip_addr[4]; // server ip address in 8-bits
olympux 14:18eda020a589 147 char str_server_ip_addr[16];// for printf, converted from 16-bits u16server_ip_addr
olympux 12:7c152c0ca4d8 148 uint16_t u16tcp_server_port; // directly loaded from eeprom
olympux 18:ca499a2e7da6 149 uint16_t u16enable_tcp_client, u16enable_tcp_server;// flags for enabling TCP client or TCP server
olympux 12:7c152c0ca4d8 150
olympux 19:05934ee9ee67 151 char tcp_receiving_buffer[256];
olympux 19:05934ee9ee67 152 char tcp_sending_buffer[256]; // socket buffer
olympux 19:05934ee9ee67 153 char udp_receiving_buffer[256];
olympux 12:7c152c0ca4d8 154
olympux 0:c2eac797face 155
olympux 13:bcf840da68fd 156 /*
olympux 13:bcf840da68fd 157 * Protocol
olympux 13:bcf840da68fd 158 */
olympux 9:d2534ecf88c6 159 // Commands
olympux 17:88ef7a078095 160 #define DEVICE_ID "NNIO"
olympux 17:88ef7a078095 161
olympux 17:88ef7a078095 162 #define RECEIVING_PROTOCOL_LENGTH 58
olympux 17:88ef7a078095 163 #define SENDING_PROTOCOL_LENGTH 39
olympux 17:88ef7a078095 164 #define QUERY_CMD_LENGTH 6
olympux 17:88ef7a078095 165 #define SET_NETWORK_CONFIG_CMD_LENGTH 19
olympux 17:88ef7a078095 166 #define UPDATE_TCP_SERVER_INFO_CMD_LENGTH 12
olympux 17:88ef7a078095 167
olympux 17:88ef7a078095 168 #define QUERY_DISCOVERY_CMD "NNIODS"
olympux 17:88ef7a078095 169 #define QUERY_IP_CMD "NNIOIP"
olympux 17:88ef7a078095 170 #define QUERY_SUBNET_CMD "NNIOSN"
olympux 17:88ef7a078095 171 #define QUERY_GATEWAY_CMD "NNIOGW"
olympux 17:88ef7a078095 172 #define QUERY_MAC_CMD "NNIOMC"
olympux 17:88ef7a078095 173 #define QUERY_UDP_PORT_CMD "NNIOUP"
olympux 17:88ef7a078095 174 #define QUERY_TCP_PORT_CMD "NNIOTP"
olympux 17:88ef7a078095 175 #define QUERY_UPDATE_TIME_CMD "NNIOTM"
olympux 11:709f90a3b599 176 #define RECEIVING_PROTOCOL_ENABLE_OUTPUT 'O'
olympux 11:709f90a3b599 177 #define QUERY_STATUS_COMMAND 'Q'
olympux 11:709f90a3b599 178 #define DIGITAL_HIGH 'H'
olympux 11:709f90a3b599 179 #define DIGITAL_LOW 'L'
olympux 9:d2534ecf88c6 180
olympux 9:d2534ecf88c6 181
olympux 9:d2534ecf88c6 182 // Positions
olympux 11:709f90a3b599 183 #define RECEIVING_PROTOCOL_ID_POS 0
olympux 9:d2534ecf88c6 184 #define RECEIVING_PROTOCOL_OP_POS 4
olympux 9:d2534ecf88c6 185 #define RECEIVING_PROTOCOL_EN_DO_POS RECEIVING_PROTOCOL_OP_POS + 0
olympux 9:d2534ecf88c6 186 #define RECEIVING_PROTOCOL_EN_A0O_POS RECEIVING_PROTOCOL_OP_POS + 1
olympux 9:d2534ecf88c6 187 #define RECEIVING_PROTOCOL_EN_A1O_POS RECEIVING_PROTOCOL_OP_POS + 2
olympux 9:d2534ecf88c6 188 #define RECEIVING_PROTOCOL_EN_UART_POS RECEIVING_PROTOCOL_OP_POS + 3
olympux 9:d2534ecf88c6 189 #define RECEIVING_PROTOCOL_COMMAND_POS RECEIVING_PROTOCOL_OP_POS + 4
olympux 11:709f90a3b599 190
olympux 11:709f90a3b599 191 #define RECEIVING_PROTOCOL_IP_POS 9
olympux 11:709f90a3b599 192 #define RECEIVING_PROTOCOL_DO_POS 13
olympux 11:709f90a3b599 193 #define RECEIVING_PROTOCOL_A0O_POS 21
olympux 11:709f90a3b599 194 #define RECEIVING_PROTOCOL_A01_POS 23
olympux 11:709f90a3b599 195 #define RECEIVING_PROTOCOL_UART_POS 25
olympux 9:d2534ecf88c6 196
olympux 9:d2534ecf88c6 197
olympux 11:709f90a3b599 198 #define SENDING_PROTOCOL_ID_POS 0
olympux 11:709f90a3b599 199 #define SENDING_PROTOCOL_MAC_POS 4
olympux 11:709f90a3b599 200 #define SENDING_PROTOCOL_IP_POS 10
olympux 11:709f90a3b599 201 #define SENDING_PROTOCOL_DI_POS 14
olympux 11:709f90a3b599 202 #define SENDING_PROTOCOL_DO_POS 22
olympux 11:709f90a3b599 203 #define SENDING_PROTOCOL_AI0_POS 30
olympux 11:709f90a3b599 204 #define SENDING_PROTOCOL_AI1_POS 32
olympux 11:709f90a3b599 205 #define SENDING_PROTOCOL_AO0_POS 34
olympux 11:709f90a3b599 206 #define SENDING_PROTOCOL_AO1_POS 36
olympux 11:709f90a3b599 207 #define SENDING_PROTOCOL_CR_POS 38
olympux 0:c2eac797face 208
olympux 2:18f10e7209f4 209
olympux 2:18f10e7209f4 210 /*
olympux 2:18f10e7209f4 211 * RTOS
olympux 2:18f10e7209f4 212 */
olympux 2:18f10e7209f4 213 struct message_t {
olympux 2:18f10e7209f4 214 int len;
olympux 2:18f10e7209f4 215 char *msg;
olympux 2:18f10e7209f4 216 };
olympux 3:972ed747474c 217 Queue<message_t, 16> uart_queue;
olympux 15:edeb0aed160d 218 Queue<bool, 1> auto_update_queue;
olympux 2:18f10e7209f4 219
olympux 2:18f10e7209f4 220
olympux 2:18f10e7209f4 221 /*
olympux 2:18f10e7209f4 222 * Threads
olympux 2:18f10e7209f4 223 */
olympux 15:edeb0aed160d 224 // Timer thread for auto update
olympux 15:edeb0aed160d 225 void auto_update_timer_thread(void const* args) {
olympux 18:ca499a2e7da6 226 bool update_flag = true;
olympux 15:edeb0aed160d 227
olympux 15:edeb0aed160d 228 Thread::wait(500);
olympux 15:edeb0aed160d 229 while(true) {
olympux 15:edeb0aed160d 230 auto_update_queue.put(&update_flag);
olympux 18:ca499a2e7da6 231 Thread::wait(1000*transmit_time_period); // Thread::wait() in ms
olympux 15:edeb0aed160d 232 }
olympux 15:edeb0aed160d 233 }
olympux 15:edeb0aed160d 234
olympux 15:edeb0aed160d 235
olympux 20:71c7950fdd91 236 // WDT reset
olympux 20:71c7950fdd91 237 void wdt_reset_thread(void const* args) {
olympux 20:71c7950fdd91 238 while (true)
olympux 20:71c7950fdd91 239 wdt.Service();
olympux 20:71c7950fdd91 240 }
olympux 20:71c7950fdd91 241
olympux 20:71c7950fdd91 242
olympux 6:d054e394fba3 243 /*
olympux 6:d054e394fba3 244 * Ethernet init
olympux 6:d054e394fba3 245 */
olympux 4:568c97f2a407 246 int ethernet_init(void) {
olympux 18:ca499a2e7da6 247 DBG("Start initialising ethernet");
olympux 14:18eda020a589 248 int ret = eth.init(u8mac, str_ip_addr, str_ip_subnet, str_ip_gateway); // static
olympux 0:c2eac797face 249
olympux 0:c2eac797face 250 if (!ret) {
olympux 18:ca499a2e7da6 251 DBG("Initialized, MAC: %s", eth.getMACAddress());
olympux 0:c2eac797face 252 } else {
olympux 18:ca499a2e7da6 253 ERR("Error eth.init() - ret = %d", ret);
olympux 0:c2eac797face 254 return -1;
olympux 0:c2eac797face 255 }
olympux 0:c2eac797face 256
olympux 0:c2eac797face 257 ret = eth.connect();
olympux 0:c2eac797face 258 if (!ret) {
olympux 18:ca499a2e7da6 259 DBG("IP: %s, MASK: %s, GW: %s", eth.getIPAddress(), eth.getNetworkMask(), eth.getGateway());
olympux 0:c2eac797face 260 } else {
olympux 18:ca499a2e7da6 261 ERR("Error eth.connect() - ret = %d", ret);
olympux 0:c2eac797face 262 return -1;
olympux 0:c2eac797face 263 }
olympux 3:972ed747474c 264
olympux 4:568c97f2a407 265 return 0;
olympux 4:568c97f2a407 266 }
olympux 4:568c97f2a407 267
olympux 4:568c97f2a407 268
olympux 19:05934ee9ee67 269 /*
olympux 19:05934ee9ee67 270 * Procedure to process receiving protocol
olympux 19:05934ee9ee67 271 */
olympux 19:05934ee9ee67 272 void process_received_tcp_data(char* received_buffer, int len)
olympux 19:05934ee9ee67 273 {
olympux 19:05934ee9ee67 274 char* received_frame;
olympux 19:05934ee9ee67 275 int pos;
olympux 19:05934ee9ee67 276
olympux 19:05934ee9ee67 277 while (len >= RECEIVING_PROTOCOL_LENGTH) {
olympux 19:05934ee9ee67 278 // find device ID
olympux 19:05934ee9ee67 279 DBG("Checking device ID...");
olympux 19:05934ee9ee67 280 char* id = strstr(received_buffer, DEVICE_ID);
olympux 19:05934ee9ee67 281 if (id == NULL) {
olympux 19:05934ee9ee67 282 DBG("No device ID found");
olympux 19:05934ee9ee67 283 break;
olympux 19:05934ee9ee67 284 }
olympux 19:05934ee9ee67 285 pos = id - received_buffer;
olympux 19:05934ee9ee67 286 DBG("Found a frame at %d", pos);
olympux 19:05934ee9ee67 287
olympux 19:05934ee9ee67 288 // extract this frame
olympux 19:05934ee9ee67 289 received_frame = &received_buffer[pos];
olympux 19:05934ee9ee67 290 // calculate the rest
olympux 19:05934ee9ee67 291 received_buffer = &received_buffer[pos + RECEIVING_PROTOCOL_LENGTH];
olympux 19:05934ee9ee67 292 len -= RECEIVING_PROTOCOL_LENGTH;
olympux 19:05934ee9ee67 293
olympux 19:05934ee9ee67 294 // process this received frame
olympux 19:05934ee9ee67 295 // firstly, update outputs if required
olympux 19:05934ee9ee67 296 // digital outputs
olympux 19:05934ee9ee67 297 if (received_frame[RECEIVING_PROTOCOL_EN_DO_POS] == RECEIVING_PROTOCOL_ENABLE_OUTPUT) {
olympux 19:05934ee9ee67 298 DBG("Update digital outputs");
olympux 19:05934ee9ee67 299 char str_dout[9];
olympux 19:05934ee9ee67 300 memcpy(str_dout, &received_frame[RECEIVING_PROTOCOL_DO_POS], 8);
olympux 19:05934ee9ee67 301 str_dout[8] = '\0';
olympux 19:05934ee9ee67 302 update_digital_outputs(str_dout);
olympux 19:05934ee9ee67 303 }
olympux 19:05934ee9ee67 304 // analog output 0
olympux 19:05934ee9ee67 305 if (received_frame[RECEIVING_PROTOCOL_EN_A0O_POS] == RECEIVING_PROTOCOL_ENABLE_OUTPUT) {
olympux 19:05934ee9ee67 306 DBG("Update analog output 0");
olympux 19:05934ee9ee67 307 }
olympux 19:05934ee9ee67 308 // analog output 1
olympux 19:05934ee9ee67 309 if (received_buffer[RECEIVING_PROTOCOL_EN_A1O_POS] == RECEIVING_PROTOCOL_ENABLE_OUTPUT) {
olympux 19:05934ee9ee67 310 DBG("Update analog output 1");
olympux 19:05934ee9ee67 311 }
olympux 19:05934ee9ee67 312 // UART
olympux 19:05934ee9ee67 313 if (received_frame[RECEIVING_PROTOCOL_EN_UART_POS] == RECEIVING_PROTOCOL_ENABLE_OUTPUT) {
olympux 19:05934ee9ee67 314 DBG("UART data: ");
olympux 19:05934ee9ee67 315 char str_uart[33];
olympux 19:05934ee9ee67 316 memcpy(str_uart, &received_frame[RECEIVING_PROTOCOL_UART_POS], 32);
olympux 19:05934ee9ee67 317 str_uart[32] = '\0';
olympux 19:05934ee9ee67 318 printf("%s\r\n", str_uart);
olympux 19:05934ee9ee67 319 }
olympux 19:05934ee9ee67 320
olympux 19:05934ee9ee67 321 // then, check query status command and sending protocol if required
olympux 19:05934ee9ee67 322 if (received_frame[RECEIVING_PROTOCOL_COMMAND_POS] == QUERY_STATUS_COMMAND) {
olympux 19:05934ee9ee67 323 DBG("Requested to send device status through TCP");
olympux 19:05934ee9ee67 324 // sending protocol
olympux 19:05934ee9ee67 325 update_sending_frame(tcp_sending_buffer);
olympux 19:05934ee9ee67 326 tcp_client.send_all(tcp_sending_buffer, SENDING_PROTOCOL_LENGTH);
olympux 19:05934ee9ee67 327 DBG("Sent");
olympux 19:05934ee9ee67 328 }
olympux 19:05934ee9ee67 329 }
olympux 19:05934ee9ee67 330
olympux 19:05934ee9ee67 331 DBG("Successful");
olympux 19:05934ee9ee67 332 }
olympux 6:d054e394fba3 333
olympux 4:568c97f2a407 334
olympux 4:568c97f2a407 335 int main()
olympux 4:568c97f2a407 336 {
olympux 9:d2534ecf88c6 337 int n, ret;
olympux 4:568c97f2a407 338
olympux 20:71c7950fdd91 339 Thread::wait(500); // turn on delay
olympux 20:71c7950fdd91 340
olympux 4:568c97f2a407 341 /*
olympux 9:d2534ecf88c6 342 * Configure
olympux 4:568c97f2a407 343 */
olympux 11:709f90a3b599 344 uart.baud(115200);
olympux 18:ca499a2e7da6 345 DBG("\r\nStarting...");
olympux 20:71c7950fdd91 346
olympux 20:71c7950fdd91 347 if (wdt.WatchdogCausedReset())
olympux 20:71c7950fdd91 348 DBG("Watchdog caused reset.");
olympux 20:71c7950fdd91 349 wdt.Configure(4);
olympux 6:d054e394fba3 350
olympux 6:d054e394fba3 351 /*
olympux 6:d054e394fba3 352 * FLASH
olympux 6:d054e394fba3 353 */
olympux 12:7c152c0ca4d8 354 load_eeprom_network();
olympux 15:edeb0aed160d 355 load_eeprom_tcpserver();
olympux 20:71c7950fdd91 356
olympux 20:71c7950fdd91 357 /*
olympux 20:71c7950fdd91 358 * UI threads
olympux 20:71c7950fdd91 359 */
olympux 20:71c7950fdd91 360 Thread t2(auto_update_timer_thread);
olympux 20:71c7950fdd91 361 Thread t3(wdt_reset_thread);
olympux 20:71c7950fdd91 362
olympux 4:568c97f2a407 363 /*
olympux 4:568c97f2a407 364 * Ethernet
olympux 4:568c97f2a407 365 */
olympux 6:d054e394fba3 366 ret = ethernet_init();
olympux 4:568c97f2a407 367 if (ret) {
olympux 18:ca499a2e7da6 368 ERR("Ethernet initialisation failed. App halted.");
olympux 4:568c97f2a407 369 while (true) {};
olympux 4:568c97f2a407 370 }
olympux 4:568c97f2a407 371
olympux 23:47ee805435b1 372 Thread::wait(2000); // TCP/UDP stack delay
olympux 12:7c152c0ca4d8 373
olympux 12:7c152c0ca4d8 374 /*
olympux 20:71c7950fdd91 375 * UDP server
olympux 20:71c7950fdd91 376 * TCP server/client
olympux 12:7c152c0ca4d8 377 */
olympux 20:71c7950fdd91 378 #ifdef UDP_SERVER
olympux 20:71c7950fdd91 379 ret = udp_server.bind(udp_server_local_port);
olympux 20:71c7950fdd91 380 DBG("UDP server started (sock.bind = %d)...", ret);
olympux 20:71c7950fdd91 381 udp_server.set_blocking(false, UDP_SERVER_RECEIVE_TIMEOUT);
olympux 20:71c7950fdd91 382 #endif
olympux 20:71c7950fdd91 383
olympux 3:972ed747474c 384 #ifdef TCP_SERVER
olympux 12:7c152c0ca4d8 385 tcp_server.bind(tcp_server_local_port);
olympux 3:972ed747474c 386 tcp_server.listen();
olympux 18:ca499a2e7da6 387 DBG("TCP server started...");
olympux 4:568c97f2a407 388 tcp_server.set_blocking(false, TCP_SERVER_WAIT_CLIENT_TIMEOUT);
olympux 3:972ed747474c 389 #endif
olympux 14:18eda020a589 390
olympux 14:18eda020a589 391 #ifdef TCP_CLIENT
olympux 18:ca499a2e7da6 392
olympux 14:18eda020a589 393 #endif
olympux 3:972ed747474c 394
olympux 12:7c152c0ca4d8 395 /*
olympux 19:05934ee9ee67 396 * Network loop processor
olympux 12:7c152c0ca4d8 397 */
olympux 0:c2eac797face 398 while (true) {
olympux 15:edeb0aed160d 399 #ifdef TCP_CLIENT
olympux 18:ca499a2e7da6 400 // FOR AUTO TRANSMIT DEVICE STATUS
olympux 18:ca499a2e7da6 401 //if ((u16enable_tcp_client == 0xA5A5) && (auto_transmit_flag == 0xA5A5)) {
olympux 18:ca499a2e7da6 402 if (auto_transmit_flag == 0xA5A5) {
olympux 18:ca499a2e7da6 403 // connect to TCP server if required
olympux 18:ca499a2e7da6 404 if (!tcp_sock.is_connected()) {
olympux 20:71c7950fdd91 405 ret = tcp_sock.connect(str_server_ip_addr, u16tcp_server_port); // timeout is default in connect() in W5500.h
olympux 18:ca499a2e7da6 406 if (ret > -1) {
olympux 18:ca499a2e7da6 407 DBG("Successfully connected to %s on port %d", str_server_ip_addr, u16tcp_server_port);
olympux 18:ca499a2e7da6 408 }
olympux 18:ca499a2e7da6 409 else {
olympux 18:ca499a2e7da6 410 ERR("Unable to connect to %s on port %d", str_server_ip_addr, u16tcp_server_port);
olympux 18:ca499a2e7da6 411 }
olympux 16:84a5bf7285d0 412 }
olympux 18:ca499a2e7da6 413
olympux 18:ca499a2e7da6 414 // transmit data if connected
olympux 18:ca499a2e7da6 415 if (tcp_sock.is_connected()) {
olympux 18:ca499a2e7da6 416 osEvent evt = auto_update_queue.get(1); // timeout after 1ms
olympux 18:ca499a2e7da6 417 if (evt.status == osEventMessage) {
olympux 18:ca499a2e7da6 418 DBG("Updating...");
olympux 19:05934ee9ee67 419 update_sending_frame(tcp_sending_buffer);
olympux 19:05934ee9ee67 420 tcp_sock.send_all(tcp_sending_buffer, SENDING_PROTOCOL_LENGTH);
olympux 19:05934ee9ee67 421 }
olympux 19:05934ee9ee67 422
olympux 19:05934ee9ee67 423 // check to receive or timeout
olympux 19:05934ee9ee67 424 tcp_sock.set_blocking(false, TCP_CLIENT_RECEIVE_TIMEOUT);
olympux 19:05934ee9ee67 425 n = tcp_sock.receive(tcp_receiving_buffer, sizeof(tcp_receiving_buffer));
olympux 19:05934ee9ee67 426 if (n > 0) {
olympux 19:05934ee9ee67 427 // got some data, test it
olympux 19:05934ee9ee67 428 DBG("TCP client received %d bytes: %s", n, tcp_receiving_buffer);
olympux 19:05934ee9ee67 429 process_received_tcp_data(tcp_receiving_buffer, n);
olympux 18:ca499a2e7da6 430 }
olympux 16:84a5bf7285d0 431 }
olympux 18:ca499a2e7da6 432 } // if tcp client enabled && auto transmit
olympux 15:edeb0aed160d 433 #endif
olympux 15:edeb0aed160d 434
olympux 15:edeb0aed160d 435
olympux 9:d2534ecf88c6 436 // FOR INTERFACING
olympux 4:568c97f2a407 437 #ifdef TCP_SERVER
olympux 4:568c97f2a407 438 // no tcp client connected
olympux 18:ca499a2e7da6 439 //if ((u16enable_tcp_server == 0xA5A5) && (!tcp_client.is_connected())) {
olympux 20:71c7950fdd91 440 //if (!tcp_client.is_connected()) {
olympux 20:71c7950fdd91 441 if (1) {
olympux 4:568c97f2a407 442 // wait for client within timeout
olympux 4:568c97f2a407 443 ret = tcp_server.accept(tcp_client);
olympux 2:18f10e7209f4 444
olympux 4:568c97f2a407 445 // tcp client connected
olympux 4:568c97f2a407 446 if (ret > -1) {
olympux 18:ca499a2e7da6 447 DBG("Connection from: %s", tcp_client.get_address());
olympux 4:568c97f2a407 448
olympux 4:568c97f2a407 449 // loop waiting and receiving data within timeout
olympux 4:568c97f2a407 450 tcp_client.set_blocking(false, TCP_SERVER_RECEIVE_TIMEOUT); // Timeout after x seconds
olympux 4:568c97f2a407 451 while (true) {
olympux 19:05934ee9ee67 452 n = tcp_client.receive(tcp_receiving_buffer, sizeof(tcp_receiving_buffer));
olympux 4:568c97f2a407 453 if (n <= 0) break;
olympux 4:568c97f2a407 454
olympux 9:d2534ecf88c6 455 // got some data, test it
olympux 19:05934ee9ee67 456 DBG("TCP server received: %s", tcp_receiving_buffer);
olympux 19:05934ee9ee67 457 process_received_tcp_data(tcp_receiving_buffer, n);
olympux 4:568c97f2a407 458 } // end loop if no data received within timeout
olympux 4:568c97f2a407 459 } // if client connected
olympux 20:71c7950fdd91 460 tcp_client.close();
olympux 18:ca499a2e7da6 461 } // if tcp server enabled && no client connected
olympux 3:972ed747474c 462 #endif
olympux 20:71c7950fdd91 463
olympux 9:d2534ecf88c6 464 #ifdef UDP_SERVER
olympux 19:05934ee9ee67 465 n = udp_server.receiveFrom(ep_udp_client, udp_receiving_buffer, sizeof(udp_receiving_buffer));
olympux 21:fae96e0d6bb1 466 if ((n == QUERY_CMD_LENGTH) && (strstr(udp_receiving_buffer, QUERY_DISCOVERY_CMD) != NULL)) {
olympux 20:71c7950fdd91 467 // if receive any config command, stay in config mode forever
olympux 20:71c7950fdd91 468 DBG("Enabled configuration mode...");
olympux 20:71c7950fdd91 469 DBG("!!! RESET when finished");
olympux 20:71c7950fdd91 470 while (n > 0) {
olympux 20:71c7950fdd91 471 // got some data, test it
olympux 20:71c7950fdd91 472 DBG("UDP received (%s) from (%s) and port (%d)", udp_receiving_buffer, ep_udp_client.get_address(), ep_udp_client.get_port());
olympux 23:47ee805435b1 473
olympux 20:71c7950fdd91 474 // process received data
olympux 23:47ee805435b1 475 // a configuration command always starts with NN
olympux 23:47ee805435b1 476 if ((udp_receiving_buffer[0] == 'N') && (udp_receiving_buffer[1] == 'N')) {
olympux 23:47ee805435b1 477 switch (n) {
olympux 23:47ee805435b1 478 // length = 6, a QUERY command (discovery command, TCP port, or UDP port)
olympux 23:47ee805435b1 479 // Format: NNIODS, NNIOTP, NNIOUP, NNIOTM
olympux 23:47ee805435b1 480 case QUERY_CMD_LENGTH:
olympux 23:47ee805435b1 481 // discovery command
olympux 23:47ee805435b1 482 if (strstr(udp_receiving_buffer, QUERY_DISCOVERY_CMD) != NULL) {
olympux 23:47ee805435b1 483 char str[30];
olympux 23:47ee805435b1 484 sprintf(str, "%s%s", DEVICE_ID, eth.getIPAddress());
olympux 23:47ee805435b1 485 udp_server.sendTo(ep_udp_client, str, strlen(str));
olympux 23:47ee805435b1 486 } // NNIODS
olympux 23:47ee805435b1 487 else if (strstr(udp_receiving_buffer, QUERY_IP_CMD) != NULL) {
olympux 23:47ee805435b1 488 udp_server.sendTo(ep_udp_client, eth.getIPAddress(), strlen(eth.getIPAddress()));
olympux 23:47ee805435b1 489 } // NNIOIP
olympux 23:47ee805435b1 490 else if (strstr(udp_receiving_buffer, QUERY_SUBNET_CMD) != NULL) {
olympux 23:47ee805435b1 491 udp_server.sendTo(ep_udp_client, eth.getNetworkMask(), strlen(eth.getNetworkMask()));
olympux 23:47ee805435b1 492 } // NNIOSN
olympux 23:47ee805435b1 493 else if (strstr(udp_receiving_buffer, QUERY_GATEWAY_CMD) != NULL) {
olympux 23:47ee805435b1 494 udp_server.sendTo(ep_udp_client, eth.getGateway(), strlen(eth.getGateway()));
olympux 23:47ee805435b1 495 } // NNIOGW
olympux 23:47ee805435b1 496 else if (strstr(udp_receiving_buffer, QUERY_MAC_CMD) != NULL) {
olympux 23:47ee805435b1 497 udp_server.sendTo(ep_udp_client, eth.getMACAddress(), strlen(eth.getMACAddress()));
olympux 23:47ee805435b1 498 } // NNIOMC
olympux 23:47ee805435b1 499 // ask for TCP server port
olympux 23:47ee805435b1 500 else if (strstr(udp_receiving_buffer, QUERY_TCP_PORT_CMD) != NULL) {
olympux 23:47ee805435b1 501 char port[5];
olympux 23:47ee805435b1 502 sprintf(port, "%5d", tcp_server_local_port);
olympux 23:47ee805435b1 503 udp_server.sendTo(ep_udp_client, port, strlen(port));
olympux 23:47ee805435b1 504 } // NNIOTP
olympux 23:47ee805435b1 505 // ask for UDP server port
olympux 23:47ee805435b1 506 else if (strstr(udp_receiving_buffer, QUERY_UDP_PORT_CMD) != NULL) {
olympux 23:47ee805435b1 507 char port[5];
olympux 23:47ee805435b1 508 sprintf(port, "%5d", udp_server_local_port);
olympux 23:47ee805435b1 509 udp_server.sendTo(ep_udp_client, port, strlen(port));
olympux 23:47ee805435b1 510 } // NNIOUP
olympux 23:47ee805435b1 511 else if (strstr(udp_receiving_buffer, QUERY_UPDATE_TIME_CMD) != NULL) {
olympux 23:47ee805435b1 512 #ifdef NTP
olympux 23:47ee805435b1 513 char str_time[50];
olympux 20:71c7950fdd91 514
olympux 23:47ee805435b1 515 DBG("Trying to update time...");
olympux 23:47ee805435b1 516 if (ntp.setTime("0.pool.ntp.org") == 0) {
olympux 23:47ee805435b1 517 DBG("Set time successfully");
olympux 23:47ee805435b1 518 time_t ctTime;
olympux 23:47ee805435b1 519 ctTime = time(NULL);
olympux 23:47ee805435b1 520
olympux 23:47ee805435b1 521 DBG("Time is set to (UTC): %s", ctime(&ctTime));
olympux 23:47ee805435b1 522 sprintf(str_time, "%s", ctime(&ctTime));
olympux 23:47ee805435b1 523 udp_server.sendTo(ep_udp_client, str_time, strlen(str_time));
olympux 23:47ee805435b1 524 }
olympux 23:47ee805435b1 525 else {
olympux 23:47ee805435b1 526 WARN("Error");
olympux 23:47ee805435b1 527 sprintf(str_time, "ERR");
olympux 23:47ee805435b1 528 udp_server.sendTo(ep_udp_client, str_time, strlen(str_time));
olympux 23:47ee805435b1 529 }
olympux 23:47ee805435b1 530 #elif
olympux 23:47ee805435b1 531 WARN("NTP disabled");
olympux 23:47ee805435b1 532 sprintf(str_time, "DIS");
olympux 20:71c7950fdd91 533 udp_server.sendTo(ep_udp_client, str_time, strlen(str_time));
olympux 23:47ee805435b1 534 #endif
olympux 23:47ee805435b1 535 } // NNIOTM
olympux 23:47ee805435b1 536
olympux 20:71c7950fdd91 537 break;
olympux 23:47ee805435b1 538 // length = 19, SET NETWORK CONFIGURATION
olympux 23:47ee805435b1 539 // Format: 4E 4E 49 4F C0 A8 00 78 FF FF FF 00 C0 A8 00 01 00 00 01
olympux 23:47ee805435b1 540 // (NNIO; IP: 192.168.0.120; Subnet: 255.255.255.0; GW: 192.168.0.1; MAC: 0 0 1)
olympux 23:47ee805435b1 541 case SET_NETWORK_CONFIG_CMD_LENGTH: {
olympux 23:47ee805435b1 542 // check device id
olympux 23:47ee805435b1 543 char* id = strstr(udp_receiving_buffer, DEVICE_ID);
olympux 23:47ee805435b1 544 if (id == NULL)
olympux 23:47ee805435b1 545 break;
olympux 23:47ee805435b1 546 else if ((id - udp_receiving_buffer) > 0)
olympux 23:47ee805435b1 547 break;
olympux 23:47ee805435b1 548
olympux 23:47ee805435b1 549 DBG("Received user configuration");
olympux 23:47ee805435b1 550 write_eeprom_network(&udp_receiving_buffer[strlen(DEVICE_ID)]); // parameters from 5th char, 15-bytes
olympux 20:71c7950fdd91 551 break;
olympux 23:47ee805435b1 552 }
olympux 23:47ee805435b1 553 // length = 12, SET TCP SERVER CONFIGURATION
olympux 23:47ee805435b1 554 // auto update & its time period, TCP server configuration (IP & port)
olympux 23:47ee805435b1 555 // Format: 4E 4E 49 4F 'Y' 01 C0 A8 00 09 E0 2E (LSB MSB)
olympux 23:47ee805435b1 556 // NNIO Auto 1s 192.168.0.9 12000
olympux 23:47ee805435b1 557 case UPDATE_TCP_SERVER_INFO_CMD_LENGTH: {
olympux 23:47ee805435b1 558 char* id = strstr(udp_receiving_buffer, DEVICE_ID);
olympux 23:47ee805435b1 559 if (id == NULL)
olympux 23:47ee805435b1 560 break;
olympux 23:47ee805435b1 561 else if ((id - udp_receiving_buffer) > 0)
olympux 23:47ee805435b1 562 break;
olympux 23:47ee805435b1 563
olympux 23:47ee805435b1 564 DBG("Received TCP server configuration");
olympux 23:47ee805435b1 565 write_eeprom_tcpserver(&udp_receiving_buffer[strlen(DEVICE_ID)]); // parameters from 5th char
olympux 20:71c7950fdd91 566 break;
olympux 23:47ee805435b1 567 }
olympux 23:47ee805435b1 568 default:
olympux 20:71c7950fdd91 569 break;
olympux 23:47ee805435b1 570 } // switch (n), check configuration command length
olympux 23:47ee805435b1 571 } // if starts with NN, a config command
olympux 23:47ee805435b1 572 else { // if not a command, check to see if it is a data package
olympux 23:47ee805435b1 573 // process data package
olympux 23:47ee805435b1 574 }
olympux 15:edeb0aed160d 575
olympux 20:71c7950fdd91 576 // wait to receive new config command
olympux 20:71c7950fdd91 577 udp_server.set_blocking(true);
olympux 20:71c7950fdd91 578 n = udp_server.receiveFrom(ep_udp_client, udp_receiving_buffer, sizeof(udp_receiving_buffer));
olympux 20:71c7950fdd91 579 } // while (1): config commands processor
olympux 20:71c7950fdd91 580 } // udp config timeout?
olympux 3:972ed747474c 581 #endif
olympux 4:568c97f2a407 582 } // network processor
olympux 11:709f90a3b599 583 }
olympux 11:709f90a3b599 584
olympux 12:7c152c0ca4d8 585 /*
olympux 12:7c152c0ca4d8 586 * Update digital outputs following receiving frame from TCP client
olympux 12:7c152c0ca4d8 587 */
olympux 12:7c152c0ca4d8 588 void update_digital_outputs(char* buf) {
olympux 18:ca499a2e7da6 589 DBG("Digital outputs: %s", buf);
olympux 11:709f90a3b599 590
olympux 12:7c152c0ca4d8 591 dout0 = (buf[0] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 592 dout1 = (buf[1] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 593 dout2 = (buf[2] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 594 dout3 = (buf[3] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 595 dout4 = (buf[4] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 596 dout5 = (buf[5] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 597 dout6 = (buf[6] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 598 dout7 = (buf[7] == DIGITAL_HIGH)? 1 : 0;
olympux 12:7c152c0ca4d8 599 }
olympux 12:7c152c0ca4d8 600
olympux 12:7c152c0ca4d8 601 void update_sending_frame(char* buf) {
olympux 12:7c152c0ca4d8 602 memcpy(&buf[SENDING_PROTOCOL_ID_POS], DEVICE_ID, 4); // device id
olympux 12:7c152c0ca4d8 603 memcpy(&buf[SENDING_PROTOCOL_MAC_POS], &u8mac, 6);
olympux 12:7c152c0ca4d8 604 memcpy(&buf[SENDING_PROTOCOL_IP_POS], &u8ip_addr, 4);
olympux 11:709f90a3b599 605
olympux 12:7c152c0ca4d8 606 buf[SENDING_PROTOCOL_DI_POS+0] = (din0 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 607 buf[SENDING_PROTOCOL_DI_POS+1] = (din1 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 608 buf[SENDING_PROTOCOL_DI_POS+2] = (din2 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 609 buf[SENDING_PROTOCOL_DI_POS+3] = (din3 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 610 buf[SENDING_PROTOCOL_DI_POS+4] = (din4 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 611 buf[SENDING_PROTOCOL_DI_POS+5] = (din5 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 612 buf[SENDING_PROTOCOL_DI_POS+6] = (din6 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 613 buf[SENDING_PROTOCOL_DI_POS+7] = (din7 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 11:709f90a3b599 614
olympux 12:7c152c0ca4d8 615 buf[SENDING_PROTOCOL_DO_POS+0] = (dout0 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 616 buf[SENDING_PROTOCOL_DO_POS+1] = (dout1 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 617 buf[SENDING_PROTOCOL_DO_POS+2] = (dout2 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 618 buf[SENDING_PROTOCOL_DO_POS+3] = (dout3 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 619 buf[SENDING_PROTOCOL_DO_POS+4] = (dout4 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 620 buf[SENDING_PROTOCOL_DO_POS+5] = (dout5 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 621 buf[SENDING_PROTOCOL_DO_POS+6] = (dout6 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 12:7c152c0ca4d8 622 buf[SENDING_PROTOCOL_DO_POS+7] = (dout7 == 1) ? DIGITAL_HIGH : DIGITAL_LOW;
olympux 11:709f90a3b599 623
olympux 15:edeb0aed160d 624 uint16_t val = ain0.read_u16(); // 16-bits normalised
olympux 15:edeb0aed160d 625 memcpy(&buf[SENDING_PROTOCOL_AI0_POS], &val, 2); // LSB MSB
olympux 15:edeb0aed160d 626 val = ain1.read_u16(); // 16-bits normalised
olympux 15:edeb0aed160d 627 memcpy(&buf[SENDING_PROTOCOL_AI1_POS], &val, 2); // LSB MSB
olympux 23:47ee805435b1 628 val = 0x1234;
olympux 15:edeb0aed160d 629 memcpy(&buf[SENDING_PROTOCOL_AO0_POS], &val, 2); // LSB MSB
olympux 23:47ee805435b1 630 val = 0x5678;
olympux 15:edeb0aed160d 631 memcpy(&buf[SENDING_PROTOCOL_AO1_POS], &val, 2); // LSB MSB
olympux 12:7c152c0ca4d8 632 buf[SENDING_PROTOCOL_CR_POS] = 0x0D;
olympux 12:7c152c0ca4d8 633 buf[SENDING_PROTOCOL_CR_POS+1] = '\0';
olympux 4:568c97f2a407 634 }