Mateusz Jaskula / Mbed 2 deprecated KL25Z_TangoIO

KL25 driver for Tango Control System

Dependencies:   mbed

WIZnet/W5500.cpp@2:9fe6f1e273b4, 2014-08-28 (annotated)

Committer:
jskl
Date:
Thu Aug 28 07:50:06 2014 +0000
Revision:
2:9fe6f1e273b4
Parent:
0:5d27c333afa6 
Fixed bugs in JSON format replies

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jskl 0:5d27c333afa6 1 /* Copyright (C) 2012 mbed.org, MIT License
jskl 0:5d27c333afa6 2 *
jskl 0:5d27c333afa6 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
jskl 0:5d27c333afa6 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
jskl 0:5d27c333afa6 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
jskl 0:5d27c333afa6 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
jskl 0:5d27c333afa6 7 * furnished to do so, subject to the following conditions:
jskl 0:5d27c333afa6 8 *
jskl 0:5d27c333afa6 9 * The above copyright notice and this permission notice shall be included in all copies or
jskl 0:5d27c333afa6 10 * substantial portions of the Software.
jskl 0:5d27c333afa6 11 *
jskl 0:5d27c333afa6 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
jskl 0:5d27c333afa6 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
jskl 0:5d27c333afa6 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
jskl 0:5d27c333afa6 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
jskl 0:5d27c333afa6 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
jskl 0:5d27c333afa6 17 */
jskl 0:5d27c333afa6 18
jskl 0:5d27c333afa6 19 #include "mbed.h"
jskl 0:5d27c333afa6 20 #include "mbed_debug.h"
jskl 0:5d27c333afa6 21 #include "wiznet.h"
jskl 0:5d27c333afa6 22 #include "DNSClient.h"
jskl 0:5d27c333afa6 23
jskl 0:5d27c333afa6 24 #ifdef USE_W5500
jskl 0:5d27c333afa6 25 //Debug is disabled by default
jskl 0:5d27c333afa6 26 #if 0
jskl 0:5d27c333afa6 27 #define DBG(...) do{debug("%p %d %s ", this,__LINE__,__PRETTY_FUNCTION__); debug(__VA_ARGS__); } while(0);
jskl 0:5d27c333afa6 28 //#define DBG(x, ...) debug("[W5500:DBG]"x"\r\n", ##__VA_ARGS__);
jskl 0:5d27c333afa6 29 #define WARN(x, ...) debug("[W5500:WARN]"x"\r\n", ##__VA_ARGS__);
jskl 0:5d27c333afa6 30 #define ERR(x, ...) debug("[W5500:ERR]"x"\r\n", ##__VA_ARGS__);
jskl 0:5d27c333afa6 31 #else
jskl 0:5d27c333afa6 32 #define DBG(x, ...)
jskl 0:5d27c333afa6 33 #define WARN(x, ...)
jskl 0:5d27c333afa6 34 #define ERR(x, ...)
jskl 0:5d27c333afa6 35 #endif
jskl 0:5d27c333afa6 36
jskl 0:5d27c333afa6 37 #if 1
jskl 0:5d27c333afa6 38 #define INFO(x, ...) debug("[W5500:INFO]"x"\r\n", ##__VA_ARGS__);
jskl 0:5d27c333afa6 39 #else
jskl 0:5d27c333afa6 40 #define INFO(x, ...)
jskl 0:5d27c333afa6 41 #endif
jskl 0:5d27c333afa6 42
jskl 0:5d27c333afa6 43 #define DBG_SPI 0
jskl 0:5d27c333afa6 44
jskl 0:5d27c333afa6 45 WIZnet_Chip* WIZnet_Chip::inst;
jskl 0:5d27c333afa6 46
jskl 0:5d27c333afa6 47 WIZnet_Chip::WIZnet_Chip(PinName mosi, PinName miso, PinName sclk, PinName _cs, PinName _reset):
jskl 0:5d27c333afa6 48 cs(_cs), reset_pin(_reset)
jskl 0:5d27c333afa6 49 {
jskl 0:5d27c333afa6 50 spi = new SPI(mosi, miso, sclk);
jskl 0:5d27c333afa6 51 cs = 1;
jskl 0:5d27c333afa6 52 reset_pin = 1;
jskl 0:5d27c333afa6 53 inst = this;
jskl 0:5d27c333afa6 54 }
jskl 0:5d27c333afa6 55
jskl 0:5d27c333afa6 56 WIZnet_Chip::WIZnet_Chip(SPI* spi, PinName _cs, PinName _reset):
jskl 0:5d27c333afa6 57 cs(_cs), reset_pin(_reset)
jskl 0:5d27c333afa6 58 {
jskl 0:5d27c333afa6 59 this->spi = spi;
jskl 0:5d27c333afa6 60 cs = 1;
jskl 0:5d27c333afa6 61 reset_pin = 1;
jskl 0:5d27c333afa6 62 inst = this;
jskl 0:5d27c333afa6 63 }
jskl 0:5d27c333afa6 64
jskl 0:5d27c333afa6 65 // Set the IP
jskl 0:5d27c333afa6 66 bool WIZnet_Chip::setip()
jskl 0:5d27c333afa6 67 {
jskl 0:5d27c333afa6 68 reg_wr<uint32_t>(SIPR, ip);
jskl 0:5d27c333afa6 69 reg_wr<uint32_t>(GAR, gateway);
jskl 0:5d27c333afa6 70 reg_wr<uint32_t>(SUBR, netmask);
jskl 0:5d27c333afa6 71 return true;
jskl 0:5d27c333afa6 72 }
jskl 0:5d27c333afa6 73
jskl 0:5d27c333afa6 74 bool WIZnet_Chip::setProtocol(int socket, Protocol p)
jskl 0:5d27c333afa6 75 {
jskl 0:5d27c333afa6 76 if (socket < 0) {
jskl 0:5d27c333afa6 77 return false;
jskl 0:5d27c333afa6 78 }
jskl 0:5d27c333afa6 79 sreg<uint8_t>(socket, Sn_MR, p);
jskl 0:5d27c333afa6 80 return true;
jskl 0:5d27c333afa6 81 }
jskl 0:5d27c333afa6 82
jskl 0:5d27c333afa6 83 bool WIZnet_Chip::connect(int socket, const char * host, int port, int timeout_ms)
jskl 0:5d27c333afa6 84 {
jskl 0:5d27c333afa6 85 if (socket < 0) {
jskl 0:5d27c333afa6 86 return false;
jskl 0:5d27c333afa6 87 }
jskl 0:5d27c333afa6 88 sreg<uint8_t>(socket, Sn_MR, TCP);
jskl 0:5d27c333afa6 89 scmd(socket, OPEN);
jskl 0:5d27c333afa6 90 sreg_ip(socket, Sn_DIPR, host);
jskl 0:5d27c333afa6 91 sreg<uint16_t>(socket, Sn_DPORT, port);
jskl 0:5d27c333afa6 92 sreg<uint16_t>(socket, Sn_PORT, new_port());
jskl 0:5d27c333afa6 93 scmd(socket, CONNECT);
jskl 0:5d27c333afa6 94 Timer t;
jskl 0:5d27c333afa6 95 t.reset();
jskl 0:5d27c333afa6 96 t.start();
jskl 0:5d27c333afa6 97 while(!is_connected(socket)) {
jskl 0:5d27c333afa6 98 if (t.read_ms() > timeout_ms) {
jskl 0:5d27c333afa6 99 return false;
jskl 0:5d27c333afa6 100 }
jskl 0:5d27c333afa6 101 }
jskl 0:5d27c333afa6 102 return true;
jskl 0:5d27c333afa6 103 }
jskl 0:5d27c333afa6 104
jskl 0:5d27c333afa6 105 bool WIZnet_Chip::gethostbyname(const char* host, uint32_t* ip)
jskl 0:5d27c333afa6 106 {
jskl 0:5d27c333afa6 107 uint32_t addr = str_to_ip(host);
jskl 0:5d27c333afa6 108 char buf[17];
jskl 0:5d27c333afa6 109 snprintf(buf, sizeof(buf), "%d.%d.%d.%d", (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff);
jskl 0:5d27c333afa6 110 if (strcmp(buf, host) == 0) {
jskl 0:5d27c333afa6 111 *ip = addr;
jskl 0:5d27c333afa6 112 return true;
jskl 0:5d27c333afa6 113 }
jskl 0:5d27c333afa6 114 DNSClient client;
jskl 0:5d27c333afa6 115 if(client.lookup(host)) {
jskl 0:5d27c333afa6 116 *ip = client.ip;
jskl 0:5d27c333afa6 117 return true;
jskl 0:5d27c333afa6 118 }
jskl 0:5d27c333afa6 119 return false;
jskl 0:5d27c333afa6 120 }
jskl 0:5d27c333afa6 121
jskl 0:5d27c333afa6 122 bool WIZnet_Chip::disconnect()
jskl 0:5d27c333afa6 123 {
jskl 0:5d27c333afa6 124 return true;
jskl 0:5d27c333afa6 125 }
jskl 0:5d27c333afa6 126
jskl 0:5d27c333afa6 127 bool WIZnet_Chip::is_connected(int socket)
jskl 0:5d27c333afa6 128 {
jskl 0:5d27c333afa6 129 /*
jskl 0:5d27c333afa6 130 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_ESTABLISHED) {
jskl 0:5d27c333afa6 131 return true;
jskl 0:5d27c333afa6 132 }
jskl 0:5d27c333afa6 133 */
jskl 0:5d27c333afa6 134 uint8_t tmpSn_SR;
jskl 0:5d27c333afa6 135 tmpSn_SR = sreg<uint8_t>(socket, Sn_SR);
jskl 0:5d27c333afa6 136 // packet sending is possible, when state is SOCK_CLOSE_WAIT.
jskl 0:5d27c333afa6 137 if ((tmpSn_SR == SOCK_ESTABLISHED) || (tmpSn_SR == SOCK_CLOSE_WAIT)) {
jskl 0:5d27c333afa6 138 return true;
jskl 0:5d27c333afa6 139 }
jskl 0:5d27c333afa6 140 return false;
jskl 0:5d27c333afa6 141 }
jskl 0:5d27c333afa6 142
jskl 0:5d27c333afa6 143 // Reset the chip & set the buffer
jskl 0:5d27c333afa6 144 void WIZnet_Chip::reset()
jskl 0:5d27c333afa6 145 {
jskl 0:5d27c333afa6 146 reset_pin = 1;
jskl 0:5d27c333afa6 147 reset_pin = 0;
jskl 0:5d27c333afa6 148 wait_us(500); // 500us (w5500)
jskl 0:5d27c333afa6 149 reset_pin = 1;
jskl 0:5d27c333afa6 150 wait_ms(400); // 400ms (w5500)
jskl 0:5d27c333afa6 151
jskl 0:5d27c333afa6 152 #if defined(USE_WIZ550IO_MAC)
jskl 0:5d27c333afa6 153 reg_rd_mac(SHAR, mac); // read the MAC address inside the module
jskl 0:5d27c333afa6 154 #endif
jskl 0:5d27c333afa6 155
jskl 0:5d27c333afa6 156 reg_wr_mac(SHAR, mac);
jskl 0:5d27c333afa6 157
jskl 0:5d27c333afa6 158 // set RX and TX buffer size
jskl 0:5d27c333afa6 159 for (int socket = 0; socket < MAX_SOCK_NUM; socket++) {
jskl 0:5d27c333afa6 160 sreg<uint8_t>(socket, Sn_RXBUF_SIZE, 2);
jskl 0:5d27c333afa6 161 sreg<uint8_t>(socket, Sn_TXBUF_SIZE, 2);
jskl 0:5d27c333afa6 162 }
jskl 0:5d27c333afa6 163 }
jskl 0:5d27c333afa6 164
jskl 0:5d27c333afa6 165
jskl 0:5d27c333afa6 166 bool WIZnet_Chip::close(int socket)
jskl 0:5d27c333afa6 167 {
jskl 0:5d27c333afa6 168 if (socket < 0) {
jskl 0:5d27c333afa6 169 return false;
jskl 0:5d27c333afa6 170 }
jskl 0:5d27c333afa6 171 // if not connected, return
jskl 0:5d27c333afa6 172 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
jskl 0:5d27c333afa6 173 return true;
jskl 0:5d27c333afa6 174 }
jskl 0:5d27c333afa6 175 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
jskl 0:5d27c333afa6 176 scmd(socket, DISCON);
jskl 0:5d27c333afa6 177 }
jskl 0:5d27c333afa6 178 scmd(socket, CLOSE);
jskl 0:5d27c333afa6 179 sreg<uint8_t>(socket, Sn_IR, 0xff);
jskl 0:5d27c333afa6 180 return true;
jskl 0:5d27c333afa6 181 }
jskl 0:5d27c333afa6 182
jskl 0:5d27c333afa6 183 int WIZnet_Chip::wait_readable(int socket, int wait_time_ms, int req_size)
jskl 0:5d27c333afa6 184 {
jskl 0:5d27c333afa6 185 if (socket < 0) {
jskl 0:5d27c333afa6 186 return -1;
jskl 0:5d27c333afa6 187 }
jskl 0:5d27c333afa6 188 Timer t;
jskl 0:5d27c333afa6 189 t.reset();
jskl 0:5d27c333afa6 190 t.start();
jskl 0:5d27c333afa6 191 while(1) {
jskl 0:5d27c333afa6 192 //int size = sreg<uint16_t>(socket, Sn_RX_RSR);
jskl 0:5d27c333afa6 193 // during the reading Sn_RX_RXR, it has the possible change of this register.
jskl 0:5d27c333afa6 194 // so read twice and get same value then use size information.
jskl 0:5d27c333afa6 195 int size, size2;
jskl 0:5d27c333afa6 196 do {
jskl 0:5d27c333afa6 197 size = sreg<uint16_t>(socket, Sn_RX_RSR);
jskl 0:5d27c333afa6 198 size2 = sreg<uint16_t>(socket, Sn_RX_RSR);
jskl 0:5d27c333afa6 199 } while (size != size2);
jskl 0:5d27c333afa6 200
jskl 0:5d27c333afa6 201 if (size > req_size) {
jskl 0:5d27c333afa6 202 return size;
jskl 0:5d27c333afa6 203 }
jskl 0:5d27c333afa6 204 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
jskl 0:5d27c333afa6 205 break;
jskl 0:5d27c333afa6 206 }
jskl 0:5d27c333afa6 207 }
jskl 0:5d27c333afa6 208 return -1;
jskl 0:5d27c333afa6 209 }
jskl 0:5d27c333afa6 210
jskl 0:5d27c333afa6 211 int WIZnet_Chip::wait_writeable(int socket, int wait_time_ms, int req_size)
jskl 0:5d27c333afa6 212 {
jskl 0:5d27c333afa6 213 if (socket < 0) {
jskl 0:5d27c333afa6 214 return -1;
jskl 0:5d27c333afa6 215 }
jskl 0:5d27c333afa6 216 Timer t;
jskl 0:5d27c333afa6 217 t.reset();
jskl 0:5d27c333afa6 218 t.start();
jskl 0:5d27c333afa6 219 while(1) {
jskl 0:5d27c333afa6 220 //int size = sreg<uint16_t>(socket, Sn_TX_FSR);
jskl 0:5d27c333afa6 221 // during the reading Sn_TX_FSR, it has the possible change of this register.
jskl 0:5d27c333afa6 222 // so read twice and get same value then use size information.
jskl 0:5d27c333afa6 223 int size, size2;
jskl 0:5d27c333afa6 224 do {
jskl 0:5d27c333afa6 225 size = sreg<uint16_t>(socket, Sn_TX_FSR);
jskl 0:5d27c333afa6 226 size2 = sreg<uint16_t>(socket, Sn_TX_FSR);
jskl 0:5d27c333afa6 227 } while (size != size2);
jskl 0:5d27c333afa6 228
jskl 0:5d27c333afa6 229 if (size > req_size) {
jskl 0:5d27c333afa6 230 return size;
jskl 0:5d27c333afa6 231 }
jskl 0:5d27c333afa6 232 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
jskl 0:5d27c333afa6 233 break;
jskl 0:5d27c333afa6 234 }
jskl 0:5d27c333afa6 235 }
jskl 0:5d27c333afa6 236 return -1;
jskl 0:5d27c333afa6 237 }
jskl 0:5d27c333afa6 238
jskl 0:5d27c333afa6 239 int WIZnet_Chip::send(int socket, const char * str, int len)
jskl 0:5d27c333afa6 240 {
jskl 0:5d27c333afa6 241 if (socket < 0) {
jskl 0:5d27c333afa6 242 return -1;
jskl 0:5d27c333afa6 243 }
jskl 0:5d27c333afa6 244 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
jskl 0:5d27c333afa6 245 uint8_t cntl_byte = (0x14 + (socket << 5));
jskl 0:5d27c333afa6 246 spi_write(ptr, cntl_byte, (uint8_t*)str, len);
jskl 0:5d27c333afa6 247 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
jskl 0:5d27c333afa6 248 scmd(socket, SEND);
jskl 0:5d27c333afa6 249 uint8_t tmp_Sn_IR;
jskl 0:5d27c333afa6 250 while (( (tmp_Sn_IR = sreg<uint8_t>(socket, Sn_IR)) & INT_SEND_OK) != INT_SEND_OK) {
jskl 0:5d27c333afa6 251 // @Jul.10, 2014 fix contant name, and udp sendto function.
jskl 0:5d27c333afa6 252 switch (sreg<uint8_t>(socket, Sn_SR)) {
jskl 0:5d27c333afa6 253 case SOCK_CLOSED :
jskl 0:5d27c333afa6 254 close(socket);
jskl 0:5d27c333afa6 255 return 0;
jskl 0:5d27c333afa6 256 //break;
jskl 0:5d27c333afa6 257 case SOCK_UDP :
jskl 0:5d27c333afa6 258 // ARP timeout is possible.
jskl 0:5d27c333afa6 259 if ((tmp_Sn_IR & INT_TIMEOUT) == INT_TIMEOUT) {
jskl 0:5d27c333afa6 260 sreg<uint8_t>(socket, Sn_IR, INT_TIMEOUT);
jskl 0:5d27c333afa6 261 return 0;
jskl 0:5d27c333afa6 262 }
jskl 0:5d27c333afa6 263 break;
jskl 0:5d27c333afa6 264 default :
jskl 0:5d27c333afa6 265 break;
jskl 0:5d27c333afa6 266 }
jskl 0:5d27c333afa6 267 }
jskl 0:5d27c333afa6 268 /*
jskl 0:5d27c333afa6 269 while ((sreg<uint8_t>(socket, Sn_IR) & INT_SEND_OK) != INT_SEND_OK) {
jskl 0:5d27c333afa6 270 if (sreg<uint8_t>(socket, Sn_SR) == CLOSED) {
jskl 0:5d27c333afa6 271 close(socket);
jskl 0:5d27c333afa6 272 return 0;
jskl 0:5d27c333afa6 273 }
jskl 0:5d27c333afa6 274 }
jskl 0:5d27c333afa6 275 */
jskl 0:5d27c333afa6 276 sreg<uint8_t>(socket, Sn_IR, INT_SEND_OK);
jskl 0:5d27c333afa6 277
jskl 0:5d27c333afa6 278 return len;
jskl 0:5d27c333afa6 279 }
jskl 0:5d27c333afa6 280
jskl 0:5d27c333afa6 281 int WIZnet_Chip::recv(int socket, char* buf, int len)
jskl 0:5d27c333afa6 282 {
jskl 0:5d27c333afa6 283 if (socket < 0) {
jskl 0:5d27c333afa6 284 return -1;
jskl 0:5d27c333afa6 285 }
jskl 0:5d27c333afa6 286 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
jskl 0:5d27c333afa6 287 uint8_t cntl_byte = (0x18 + (socket << 5));
jskl 0:5d27c333afa6 288 spi_read(ptr, cntl_byte, (uint8_t*)buf, len);
jskl 0:5d27c333afa6 289 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
jskl 0:5d27c333afa6 290 scmd(socket, RECV);
jskl 0:5d27c333afa6 291 return len;
jskl 0:5d27c333afa6 292 }
jskl 0:5d27c333afa6 293
jskl 0:5d27c333afa6 294 int WIZnet_Chip::new_socket()
jskl 0:5d27c333afa6 295 {
jskl 0:5d27c333afa6 296 for(int s = 0; s < MAX_SOCK_NUM; s++) {
jskl 0:5d27c333afa6 297 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
jskl 0:5d27c333afa6 298 return s;
jskl 0:5d27c333afa6 299 }
jskl 0:5d27c333afa6 300 }
jskl 0:5d27c333afa6 301 return -1;
jskl 0:5d27c333afa6 302 }
jskl 0:5d27c333afa6 303
jskl 0:5d27c333afa6 304 uint16_t WIZnet_Chip::new_port()
jskl 0:5d27c333afa6 305 {
jskl 0:5d27c333afa6 306 uint16_t port = rand();
jskl 0:5d27c333afa6 307 port |= 49152;
jskl 0:5d27c333afa6 308 return port;
jskl 0:5d27c333afa6 309 }
jskl 0:5d27c333afa6 310
jskl 0:5d27c333afa6 311 void WIZnet_Chip::scmd(int socket, Command cmd)
jskl 0:5d27c333afa6 312 {
jskl 0:5d27c333afa6 313 sreg<uint8_t>(socket, Sn_CR, cmd);
jskl 0:5d27c333afa6 314 while(sreg<uint8_t>(socket, Sn_CR));
jskl 0:5d27c333afa6 315 }
jskl 0:5d27c333afa6 316
jskl 0:5d27c333afa6 317 void WIZnet_Chip::spi_write(uint16_t addr, uint8_t cb, const uint8_t *buf, uint16_t len)
jskl 0:5d27c333afa6 318 {
jskl 0:5d27c333afa6 319 cs = 0;
jskl 0:5d27c333afa6 320 spi->write(addr >> 8);
jskl 0:5d27c333afa6 321 spi->write(addr & 0xff);
jskl 0:5d27c333afa6 322 spi->write(cb);
jskl 0:5d27c333afa6 323 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 324 spi->write(buf[i]);
jskl 0:5d27c333afa6 325 }
jskl 0:5d27c333afa6 326 cs = 1;
jskl 0:5d27c333afa6 327
jskl 0:5d27c333afa6 328 #if DBG_SPI
jskl 0:5d27c333afa6 329 debug("[SPI]W %04x(%02x %d)", addr, cb, len);
jskl 0:5d27c333afa6 330 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 331 debug(" %02x", buf[i]);
jskl 0:5d27c333afa6 332 if (i > 16) {
jskl 0:5d27c333afa6 333 debug(" ...");
jskl 0:5d27c333afa6 334 break;
jskl 0:5d27c333afa6 335 }
jskl 0:5d27c333afa6 336 }
jskl 0:5d27c333afa6 337 debug("\r\n");
jskl 0:5d27c333afa6 338 #endif
jskl 0:5d27c333afa6 339 }
jskl 0:5d27c333afa6 340
jskl 0:5d27c333afa6 341 void WIZnet_Chip::spi_read(uint16_t addr, uint8_t cb, uint8_t *buf, uint16_t len)
jskl 0:5d27c333afa6 342 {
jskl 0:5d27c333afa6 343 cs = 0;
jskl 0:5d27c333afa6 344 spi->write(addr >> 8);
jskl 0:5d27c333afa6 345 spi->write(addr & 0xff);
jskl 0:5d27c333afa6 346 spi->write(cb);
jskl 0:5d27c333afa6 347 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 348 buf[i] = spi->write(0);
jskl 0:5d27c333afa6 349 }
jskl 0:5d27c333afa6 350 cs = 1;
jskl 0:5d27c333afa6 351
jskl 0:5d27c333afa6 352 #if DBG_SPI
jskl 0:5d27c333afa6 353 debug("[SPI]R %04x(%02x %d)", addr, cb, len);
jskl 0:5d27c333afa6 354 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 355 debug(" %02x", buf[i]);
jskl 0:5d27c333afa6 356 if (i > 16) {
jskl 0:5d27c333afa6 357 debug(" ...");
jskl 0:5d27c333afa6 358 break;
jskl 0:5d27c333afa6 359 }
jskl 0:5d27c333afa6 360 }
jskl 0:5d27c333afa6 361 debug("\r\n");
jskl 0:5d27c333afa6 362 if ((addr&0xf0ff)==0x4026 || (addr&0xf0ff)==0x4003) {
jskl 0:5d27c333afa6 363 wait_ms(200);
jskl 0:5d27c333afa6 364 }
jskl 0:5d27c333afa6 365 #endif
jskl 0:5d27c333afa6 366 }
jskl 0:5d27c333afa6 367
jskl 0:5d27c333afa6 368 uint32_t str_to_ip(const char* str)
jskl 0:5d27c333afa6 369 {
jskl 0:5d27c333afa6 370 uint32_t ip = 0;
jskl 0:5d27c333afa6 371 char* p = (char*)str;
jskl 0:5d27c333afa6 372 for(int i = 0; i < 4; i++) {
jskl 0:5d27c333afa6 373 ip |= atoi(p);
jskl 0:5d27c333afa6 374 p = strchr(p, '.');
jskl 0:5d27c333afa6 375 if (p == NULL) {
jskl 0:5d27c333afa6 376 break;
jskl 0:5d27c333afa6 377 }
jskl 0:5d27c333afa6 378 ip <<= 8;
jskl 0:5d27c333afa6 379 p++;
jskl 0:5d27c333afa6 380 }
jskl 0:5d27c333afa6 381 return ip;
jskl 0:5d27c333afa6 382 }
jskl 0:5d27c333afa6 383
jskl 0:5d27c333afa6 384 void printfBytes(char* str, uint8_t* buf, int len)
jskl 0:5d27c333afa6 385 {
jskl 0:5d27c333afa6 386 printf("%s %d:", str, len);
jskl 0:5d27c333afa6 387 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 388 printf(" %02x", buf[i]);
jskl 0:5d27c333afa6 389 }
jskl 0:5d27c333afa6 390 printf("\n");
jskl 0:5d27c333afa6 391 }
jskl 0:5d27c333afa6 392
jskl 0:5d27c333afa6 393 void printHex(uint8_t* buf, int len)
jskl 0:5d27c333afa6 394 {
jskl 0:5d27c333afa6 395 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 396 if ((i%16) == 0) {
jskl 0:5d27c333afa6 397 printf("%p", buf+i);
jskl 0:5d27c333afa6 398 }
jskl 0:5d27c333afa6 399 printf(" %02x", buf[i]);
jskl 0:5d27c333afa6 400 if ((i%16) == 15) {
jskl 0:5d27c333afa6 401 printf("\n");
jskl 0:5d27c333afa6 402 }
jskl 0:5d27c333afa6 403 }
jskl 0:5d27c333afa6 404 printf("\n");
jskl 0:5d27c333afa6 405 }
jskl 0:5d27c333afa6 406
jskl 0:5d27c333afa6 407 void debug_hex(uint8_t* buf, int len)
jskl 0:5d27c333afa6 408 {
jskl 0:5d27c333afa6 409 for(int i = 0; i < len; i++) {
jskl 0:5d27c333afa6 410 if ((i%16) == 0) {
jskl 0:5d27c333afa6 411 debug("%p", buf+i);
jskl 0:5d27c333afa6 412 }
jskl 0:5d27c333afa6 413 debug(" %02x", buf[i]);
jskl 0:5d27c333afa6 414 if ((i%16) == 15) {
jskl 0:5d27c333afa6 415 debug("\n");
jskl 0:5d27c333afa6 416 }
jskl 0:5d27c333afa6 417 }
jskl 0:5d27c333afa6 418 debug("\n");
jskl 0:5d27c333afa6 419 }
jskl 0:5d27c333afa6 420
jskl 0:5d27c333afa6 421 #endif