Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: LM75B M2XStreamClient jsonlite mbed-rtos mbed Nucleo_Sensor_Shield
Fork of m2x-seeed_ethernet_demo by
WIZnet_Library/WIZnetInterface/WIZnet/W5100.cpp@11:40d8cfc941ed, 2014-12-17 (annotated)
- Committer:
- dangriffin
- Date:
- Wed Dec 17 20:45:13 2014 +0000
- Revision:
- 11:40d8cfc941ed
- Parent:
- 7:a94ba2e0cd04
Use the public Nucleo Sensor Shield library.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| SeanNewton | 7:a94ba2e0cd04 | 1 | /* Copyright (C) 2012 mbed.org, MIT License |
| SeanNewton | 7:a94ba2e0cd04 | 2 | * |
| SeanNewton | 7:a94ba2e0cd04 | 3 | * Permission is hereby granted, free of charge, to any person obtaining a copy of this software |
| SeanNewton | 7:a94ba2e0cd04 | 4 | * and associated documentation files (the "Software"), to deal in the Software without restriction, |
| SeanNewton | 7:a94ba2e0cd04 | 5 | * including without limitation the rights to use, copy, modify, merge, publish, distribute, |
| SeanNewton | 7:a94ba2e0cd04 | 6 | * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is |
| SeanNewton | 7:a94ba2e0cd04 | 7 | * furnished to do so, subject to the following conditions: |
| SeanNewton | 7:a94ba2e0cd04 | 8 | * |
| SeanNewton | 7:a94ba2e0cd04 | 9 | * The above copyright notice and this permission notice shall be included in all copies or |
| SeanNewton | 7:a94ba2e0cd04 | 10 | * substantial portions of the Software. |
| SeanNewton | 7:a94ba2e0cd04 | 11 | * |
| SeanNewton | 7:a94ba2e0cd04 | 12 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING |
| SeanNewton | 7:a94ba2e0cd04 | 13 | * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| SeanNewton | 7:a94ba2e0cd04 | 14 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
| SeanNewton | 7:a94ba2e0cd04 | 15 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| SeanNewton | 7:a94ba2e0cd04 | 16 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| SeanNewton | 7:a94ba2e0cd04 | 17 | */ |
| SeanNewton | 7:a94ba2e0cd04 | 18 | |
| SeanNewton | 7:a94ba2e0cd04 | 19 | #include "mbed.h" |
| SeanNewton | 7:a94ba2e0cd04 | 20 | #include "mbed_debug.h" |
| SeanNewton | 7:a94ba2e0cd04 | 21 | #include "wiznet.h" |
| SeanNewton | 7:a94ba2e0cd04 | 22 | #include "DNSClient.h" |
| SeanNewton | 7:a94ba2e0cd04 | 23 | |
| SeanNewton | 7:a94ba2e0cd04 | 24 | #ifdef USE_W5100 |
| SeanNewton | 7:a94ba2e0cd04 | 25 | |
| SeanNewton | 7:a94ba2e0cd04 | 26 | //Debug is disabled by default |
| SeanNewton | 7:a94ba2e0cd04 | 27 | #if 0 |
| SeanNewton | 7:a94ba2e0cd04 | 28 | #define DBG(...) do{debug("%p %d %s ", this,__LINE__,__PRETTY_FUNCTION__); debug(__VA_ARGS__); } while(0); |
| SeanNewton | 7:a94ba2e0cd04 | 29 | //#define DBG(x, ...) debug("[WIZnet_Chip:DBG]"x"\r\n", ##__VA_ARGS__); |
| SeanNewton | 7:a94ba2e0cd04 | 30 | #define WARN(x, ...) debug("[WIZnet_Chip:WARN]"x"\r\n", ##__VA_ARGS__); |
| SeanNewton | 7:a94ba2e0cd04 | 31 | #define ERR(x, ...) debug("[WIZnet_Chip:ERR]"x"\r\n", ##__VA_ARGS__); |
| SeanNewton | 7:a94ba2e0cd04 | 32 | #else |
| SeanNewton | 7:a94ba2e0cd04 | 33 | #define DBG(x, ...) |
| SeanNewton | 7:a94ba2e0cd04 | 34 | #define WARN(x, ...) |
| SeanNewton | 7:a94ba2e0cd04 | 35 | #define ERR(x, ...) |
| SeanNewton | 7:a94ba2e0cd04 | 36 | #endif |
| SeanNewton | 7:a94ba2e0cd04 | 37 | |
| SeanNewton | 7:a94ba2e0cd04 | 38 | #if 1 |
| SeanNewton | 7:a94ba2e0cd04 | 39 | #define INFO(x, ...) debug("[WIZnet_Chip:INFO]"x"\r\n", ##__VA_ARGS__); |
| SeanNewton | 7:a94ba2e0cd04 | 40 | #else |
| SeanNewton | 7:a94ba2e0cd04 | 41 | #define INFO(x, ...) |
| SeanNewton | 7:a94ba2e0cd04 | 42 | #endif |
| SeanNewton | 7:a94ba2e0cd04 | 43 | |
| SeanNewton | 7:a94ba2e0cd04 | 44 | #define DBG_SPI 0 |
| SeanNewton | 7:a94ba2e0cd04 | 45 | |
| SeanNewton | 7:a94ba2e0cd04 | 46 | WIZnet_Chip* WIZnet_Chip::inst; |
| SeanNewton | 7:a94ba2e0cd04 | 47 | |
| SeanNewton | 7:a94ba2e0cd04 | 48 | WIZnet_Chip::WIZnet_Chip(PinName mosi, PinName miso, PinName sclk, PinName _cs, PinName _reset): |
| SeanNewton | 7:a94ba2e0cd04 | 49 | cs(_cs), reset_pin(_reset) |
| SeanNewton | 7:a94ba2e0cd04 | 50 | { |
| SeanNewton | 7:a94ba2e0cd04 | 51 | spi = new SPI(mosi, miso, sclk); |
| SeanNewton | 7:a94ba2e0cd04 | 52 | |
| SeanNewton | 7:a94ba2e0cd04 | 53 | spi->format(8,0); |
| SeanNewton | 7:a94ba2e0cd04 | 54 | spi->frequency(2000000); |
| SeanNewton | 7:a94ba2e0cd04 | 55 | |
| SeanNewton | 7:a94ba2e0cd04 | 56 | cs = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 57 | reset_pin = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 58 | inst = this; |
| SeanNewton | 7:a94ba2e0cd04 | 59 | } |
| SeanNewton | 7:a94ba2e0cd04 | 60 | |
| SeanNewton | 7:a94ba2e0cd04 | 61 | WIZnet_Chip::WIZnet_Chip(SPI* spi, PinName _cs, PinName _reset): |
| SeanNewton | 7:a94ba2e0cd04 | 62 | cs(_cs), reset_pin(_reset) |
| SeanNewton | 7:a94ba2e0cd04 | 63 | { |
| SeanNewton | 7:a94ba2e0cd04 | 64 | this->spi = spi; |
| SeanNewton | 7:a94ba2e0cd04 | 65 | |
| SeanNewton | 7:a94ba2e0cd04 | 66 | this->spi->format(8,0); |
| SeanNewton | 7:a94ba2e0cd04 | 67 | this->spi->frequency(2000000); |
| SeanNewton | 7:a94ba2e0cd04 | 68 | |
| SeanNewton | 7:a94ba2e0cd04 | 69 | cs = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 70 | reset_pin = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 71 | inst = this; |
| SeanNewton | 7:a94ba2e0cd04 | 72 | } |
| SeanNewton | 7:a94ba2e0cd04 | 73 | |
| SeanNewton | 7:a94ba2e0cd04 | 74 | bool WIZnet_Chip::setip() |
| SeanNewton | 7:a94ba2e0cd04 | 75 | { |
| SeanNewton | 7:a94ba2e0cd04 | 76 | reg_wr<uint32_t>(SIPR, ip); |
| SeanNewton | 7:a94ba2e0cd04 | 77 | reg_wr<uint32_t>(GAR, gateway); |
| SeanNewton | 7:a94ba2e0cd04 | 78 | reg_wr<uint32_t>(SUBR, netmask); |
| SeanNewton | 7:a94ba2e0cd04 | 79 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 80 | } |
| SeanNewton | 7:a94ba2e0cd04 | 81 | |
| SeanNewton | 7:a94ba2e0cd04 | 82 | bool WIZnet_Chip::setProtocol(int socket, Protocol p) |
| SeanNewton | 7:a94ba2e0cd04 | 83 | { |
| SeanNewton | 7:a94ba2e0cd04 | 84 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 85 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 86 | } |
| SeanNewton | 7:a94ba2e0cd04 | 87 | sreg<uint8_t>(socket, Sn_MR, p); |
| SeanNewton | 7:a94ba2e0cd04 | 88 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 89 | } |
| SeanNewton | 7:a94ba2e0cd04 | 90 | |
| SeanNewton | 7:a94ba2e0cd04 | 91 | bool WIZnet_Chip::connect(int socket, const char * host, int port, int timeout_ms) |
| SeanNewton | 7:a94ba2e0cd04 | 92 | { |
| SeanNewton | 7:a94ba2e0cd04 | 93 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 94 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 95 | } |
| SeanNewton | 7:a94ba2e0cd04 | 96 | sreg<uint8_t>(socket, Sn_MR, TCP); |
| SeanNewton | 7:a94ba2e0cd04 | 97 | scmd(socket, OPEN); |
| SeanNewton | 7:a94ba2e0cd04 | 98 | sreg_ip(socket, Sn_DIPR, host); |
| SeanNewton | 7:a94ba2e0cd04 | 99 | sreg<uint16_t>(socket, Sn_DPORT, port); |
| SeanNewton | 7:a94ba2e0cd04 | 100 | sreg<uint16_t>(socket, Sn_PORT, new_port()); |
| SeanNewton | 7:a94ba2e0cd04 | 101 | scmd(socket, CONNECT); |
| SeanNewton | 7:a94ba2e0cd04 | 102 | Timer t; |
| SeanNewton | 7:a94ba2e0cd04 | 103 | t.reset(); |
| SeanNewton | 7:a94ba2e0cd04 | 104 | t.start(); |
| SeanNewton | 7:a94ba2e0cd04 | 105 | while(!is_connected(socket)) { |
| SeanNewton | 7:a94ba2e0cd04 | 106 | if (t.read_ms() > timeout_ms) { |
| SeanNewton | 7:a94ba2e0cd04 | 107 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 108 | } |
| SeanNewton | 7:a94ba2e0cd04 | 109 | } |
| SeanNewton | 7:a94ba2e0cd04 | 110 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 111 | } |
| SeanNewton | 7:a94ba2e0cd04 | 112 | |
| SeanNewton | 7:a94ba2e0cd04 | 113 | bool WIZnet_Chip::gethostbyname(const char* host, uint32_t* ip) |
| SeanNewton | 7:a94ba2e0cd04 | 114 | { |
| SeanNewton | 7:a94ba2e0cd04 | 115 | uint32_t addr = str_to_ip(host); |
| SeanNewton | 7:a94ba2e0cd04 | 116 | char buf[17]; |
| SeanNewton | 7:a94ba2e0cd04 | 117 | snprintf(buf, sizeof(buf), "%d.%d.%d.%d", (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff); |
| SeanNewton | 7:a94ba2e0cd04 | 118 | if (strcmp(buf, host) == 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 119 | *ip = addr; |
| SeanNewton | 7:a94ba2e0cd04 | 120 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 121 | } |
| SeanNewton | 7:a94ba2e0cd04 | 122 | DNSClient client; |
| SeanNewton | 7:a94ba2e0cd04 | 123 | if(client.lookup(host)) { |
| SeanNewton | 7:a94ba2e0cd04 | 124 | *ip = client.ip; |
| SeanNewton | 7:a94ba2e0cd04 | 125 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 126 | } |
| SeanNewton | 7:a94ba2e0cd04 | 127 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 128 | } |
| SeanNewton | 7:a94ba2e0cd04 | 129 | |
| SeanNewton | 7:a94ba2e0cd04 | 130 | bool WIZnet_Chip::disconnect() |
| SeanNewton | 7:a94ba2e0cd04 | 131 | { |
| SeanNewton | 7:a94ba2e0cd04 | 132 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 133 | } |
| SeanNewton | 7:a94ba2e0cd04 | 134 | |
| SeanNewton | 7:a94ba2e0cd04 | 135 | bool WIZnet_Chip::is_connected(int socket) |
| SeanNewton | 7:a94ba2e0cd04 | 136 | { |
| SeanNewton | 7:a94ba2e0cd04 | 137 | if (sreg<uint8_t>(socket, Sn_SR) == SOCK_ESTABLISHED) { |
| SeanNewton | 7:a94ba2e0cd04 | 138 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 139 | } |
| SeanNewton | 7:a94ba2e0cd04 | 140 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 141 | } |
| SeanNewton | 7:a94ba2e0cd04 | 142 | |
| SeanNewton | 7:a94ba2e0cd04 | 143 | void WIZnet_Chip::reset() |
| SeanNewton | 7:a94ba2e0cd04 | 144 | { |
| SeanNewton | 7:a94ba2e0cd04 | 145 | reset_pin = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 146 | reset_pin = 0; |
| SeanNewton | 7:a94ba2e0cd04 | 147 | wait_us(2); // 2us |
| SeanNewton | 7:a94ba2e0cd04 | 148 | reset_pin = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 149 | wait_ms(150); // 150ms |
| SeanNewton | 7:a94ba2e0cd04 | 150 | |
| SeanNewton | 7:a94ba2e0cd04 | 151 | reg_wr<uint8_t>(MR, 1<<7); |
| SeanNewton | 7:a94ba2e0cd04 | 152 | |
| SeanNewton | 7:a94ba2e0cd04 | 153 | reg_wr_mac(SHAR, mac); |
| SeanNewton | 7:a94ba2e0cd04 | 154 | } |
| SeanNewton | 7:a94ba2e0cd04 | 155 | |
| SeanNewton | 7:a94ba2e0cd04 | 156 | bool WIZnet_Chip::close(int socket) |
| SeanNewton | 7:a94ba2e0cd04 | 157 | { |
| SeanNewton | 7:a94ba2e0cd04 | 158 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 159 | return false; |
| SeanNewton | 7:a94ba2e0cd04 | 160 | } |
| SeanNewton | 7:a94ba2e0cd04 | 161 | // if not connected, return |
| SeanNewton | 7:a94ba2e0cd04 | 162 | if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) { |
| SeanNewton | 7:a94ba2e0cd04 | 163 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 164 | } |
| SeanNewton | 7:a94ba2e0cd04 | 165 | |
| SeanNewton | 7:a94ba2e0cd04 | 166 | scmd(socket, CLOSE); |
| SeanNewton | 7:a94ba2e0cd04 | 167 | sreg<uint8_t>(socket, Sn_IR, 0xff); |
| SeanNewton | 7:a94ba2e0cd04 | 168 | return true; |
| SeanNewton | 7:a94ba2e0cd04 | 169 | } |
| SeanNewton | 7:a94ba2e0cd04 | 170 | |
| SeanNewton | 7:a94ba2e0cd04 | 171 | int WIZnet_Chip::wait_readable(int socket, int wait_time_ms, int req_size) |
| SeanNewton | 7:a94ba2e0cd04 | 172 | { |
| SeanNewton | 7:a94ba2e0cd04 | 173 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 174 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 175 | } |
| SeanNewton | 7:a94ba2e0cd04 | 176 | Timer t; |
| SeanNewton | 7:a94ba2e0cd04 | 177 | t.reset(); |
| SeanNewton | 7:a94ba2e0cd04 | 178 | t.start(); |
| SeanNewton | 7:a94ba2e0cd04 | 179 | while(1) { |
| SeanNewton | 7:a94ba2e0cd04 | 180 | int size = 0; int size1 = 0; |
| SeanNewton | 7:a94ba2e0cd04 | 181 | do { |
| SeanNewton | 7:a94ba2e0cd04 | 182 | size = sreg<uint16_t>(socket, Sn_RX_RSR); |
| SeanNewton | 7:a94ba2e0cd04 | 183 | if (size != 0) size1 = sreg<uint16_t>(socket, Sn_RX_RSR); |
| SeanNewton | 7:a94ba2e0cd04 | 184 | }while(size != size1); |
| SeanNewton | 7:a94ba2e0cd04 | 185 | |
| SeanNewton | 7:a94ba2e0cd04 | 186 | if (size > req_size) { |
| SeanNewton | 7:a94ba2e0cd04 | 187 | return size; |
| SeanNewton | 7:a94ba2e0cd04 | 188 | } |
| SeanNewton | 7:a94ba2e0cd04 | 189 | if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) { |
| SeanNewton | 7:a94ba2e0cd04 | 190 | break; |
| SeanNewton | 7:a94ba2e0cd04 | 191 | } |
| SeanNewton | 7:a94ba2e0cd04 | 192 | } |
| SeanNewton | 7:a94ba2e0cd04 | 193 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 194 | } |
| SeanNewton | 7:a94ba2e0cd04 | 195 | |
| SeanNewton | 7:a94ba2e0cd04 | 196 | int WIZnet_Chip::wait_writeable(int socket, int wait_time_ms, int req_size) |
| SeanNewton | 7:a94ba2e0cd04 | 197 | { |
| SeanNewton | 7:a94ba2e0cd04 | 198 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 199 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 200 | } |
| SeanNewton | 7:a94ba2e0cd04 | 201 | Timer t; |
| SeanNewton | 7:a94ba2e0cd04 | 202 | t.reset(); |
| SeanNewton | 7:a94ba2e0cd04 | 203 | t.start(); |
| SeanNewton | 7:a94ba2e0cd04 | 204 | while(1) { |
| SeanNewton | 7:a94ba2e0cd04 | 205 | int size = sreg<uint16_t>(socket, Sn_TX_FSR); |
| SeanNewton | 7:a94ba2e0cd04 | 206 | if (size > req_size) { |
| SeanNewton | 7:a94ba2e0cd04 | 207 | return size; |
| SeanNewton | 7:a94ba2e0cd04 | 208 | } |
| SeanNewton | 7:a94ba2e0cd04 | 209 | if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) { |
| SeanNewton | 7:a94ba2e0cd04 | 210 | break; |
| SeanNewton | 7:a94ba2e0cd04 | 211 | } |
| SeanNewton | 7:a94ba2e0cd04 | 212 | } |
| SeanNewton | 7:a94ba2e0cd04 | 213 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 214 | } |
| SeanNewton | 7:a94ba2e0cd04 | 215 | |
| SeanNewton | 7:a94ba2e0cd04 | 216 | int WIZnet_Chip::send(int socket, const char * str, int len) |
| SeanNewton | 7:a94ba2e0cd04 | 217 | { |
| SeanNewton | 7:a94ba2e0cd04 | 218 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 219 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 220 | } |
| SeanNewton | 7:a94ba2e0cd04 | 221 | uint16_t base = 0x4000 + socket * 0x800; // each socket has 2K buffer |
| SeanNewton | 7:a94ba2e0cd04 | 222 | uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR); |
| SeanNewton | 7:a94ba2e0cd04 | 223 | uint16_t dst = base + (ptr&(0x800-1)); |
| SeanNewton | 7:a94ba2e0cd04 | 224 | if ((dst + len) > (base+0x800)) { |
| SeanNewton | 7:a94ba2e0cd04 | 225 | int len2 = base + 0x800 - dst; |
| SeanNewton | 7:a94ba2e0cd04 | 226 | spi_write(dst, (uint8_t*)str, len2); |
| SeanNewton | 7:a94ba2e0cd04 | 227 | spi_write(base, (uint8_t*)str+len2, len-len2); |
| SeanNewton | 7:a94ba2e0cd04 | 228 | } else { |
| SeanNewton | 7:a94ba2e0cd04 | 229 | spi_write(dst, (uint8_t*)str, len); |
| SeanNewton | 7:a94ba2e0cd04 | 230 | } |
| SeanNewton | 7:a94ba2e0cd04 | 231 | sreg<uint16_t>(socket, Sn_TX_WR, ptr + len); |
| SeanNewton | 7:a94ba2e0cd04 | 232 | scmd(socket, SEND); |
| SeanNewton | 7:a94ba2e0cd04 | 233 | return len; |
| SeanNewton | 7:a94ba2e0cd04 | 234 | } |
| SeanNewton | 7:a94ba2e0cd04 | 235 | |
| SeanNewton | 7:a94ba2e0cd04 | 236 | int WIZnet_Chip::recv(int socket, char* buf, int len) |
| SeanNewton | 7:a94ba2e0cd04 | 237 | { |
| SeanNewton | 7:a94ba2e0cd04 | 238 | if (socket < 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 239 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 240 | } |
| SeanNewton | 7:a94ba2e0cd04 | 241 | uint16_t base = 0x6000 + socket * 0x800; // each socket has 2K buffer |
| SeanNewton | 7:a94ba2e0cd04 | 242 | uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD); |
| SeanNewton | 7:a94ba2e0cd04 | 243 | uint16_t src = base + (ptr&(0x800-1)); |
| SeanNewton | 7:a94ba2e0cd04 | 244 | if ((src + len) > (base+0x800)) { |
| SeanNewton | 7:a94ba2e0cd04 | 245 | int len2 = base + 0x800 - src; |
| SeanNewton | 7:a94ba2e0cd04 | 246 | spi_read(src, (uint8_t*)buf, len2); |
| SeanNewton | 7:a94ba2e0cd04 | 247 | spi_read(base, (uint8_t*)buf+len2, len-len2); |
| SeanNewton | 7:a94ba2e0cd04 | 248 | } else { |
| SeanNewton | 7:a94ba2e0cd04 | 249 | spi_read(src, (uint8_t*)buf, len); |
| SeanNewton | 7:a94ba2e0cd04 | 250 | } |
| SeanNewton | 7:a94ba2e0cd04 | 251 | sreg<uint16_t>(socket, Sn_RX_RD, ptr + len); |
| SeanNewton | 7:a94ba2e0cd04 | 252 | scmd(socket, RECV); |
| SeanNewton | 7:a94ba2e0cd04 | 253 | return len; |
| SeanNewton | 7:a94ba2e0cd04 | 254 | } |
| SeanNewton | 7:a94ba2e0cd04 | 255 | |
| SeanNewton | 7:a94ba2e0cd04 | 256 | int WIZnet_Chip::new_socket() |
| SeanNewton | 7:a94ba2e0cd04 | 257 | { |
| SeanNewton | 7:a94ba2e0cd04 | 258 | for(int s = 0; s < MAX_SOCK_NUM; s++) { |
| SeanNewton | 7:a94ba2e0cd04 | 259 | if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) { |
| SeanNewton | 7:a94ba2e0cd04 | 260 | return s; |
| SeanNewton | 7:a94ba2e0cd04 | 261 | } |
| SeanNewton | 7:a94ba2e0cd04 | 262 | } |
| SeanNewton | 7:a94ba2e0cd04 | 263 | return -1; |
| SeanNewton | 7:a94ba2e0cd04 | 264 | } |
| SeanNewton | 7:a94ba2e0cd04 | 265 | |
| SeanNewton | 7:a94ba2e0cd04 | 266 | uint16_t WIZnet_Chip::new_port() |
| SeanNewton | 7:a94ba2e0cd04 | 267 | { |
| SeanNewton | 7:a94ba2e0cd04 | 268 | uint16_t port = rand(); |
| SeanNewton | 7:a94ba2e0cd04 | 269 | port |= 49152; |
| SeanNewton | 7:a94ba2e0cd04 | 270 | return port; |
| SeanNewton | 7:a94ba2e0cd04 | 271 | } |
| SeanNewton | 7:a94ba2e0cd04 | 272 | |
| SeanNewton | 7:a94ba2e0cd04 | 273 | void WIZnet_Chip::scmd(int socket, Command cmd) |
| SeanNewton | 7:a94ba2e0cd04 | 274 | { |
| SeanNewton | 7:a94ba2e0cd04 | 275 | sreg<uint8_t>(socket, Sn_CR, cmd); |
| SeanNewton | 7:a94ba2e0cd04 | 276 | while(sreg<uint8_t>(socket, Sn_CR)); |
| SeanNewton | 7:a94ba2e0cd04 | 277 | } |
| SeanNewton | 7:a94ba2e0cd04 | 278 | |
| SeanNewton | 7:a94ba2e0cd04 | 279 | void WIZnet_Chip::spi_write(uint16_t addr, const uint8_t *buf, uint16_t len) |
| SeanNewton | 7:a94ba2e0cd04 | 280 | { |
| SeanNewton | 7:a94ba2e0cd04 | 281 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 282 | cs = 0; |
| SeanNewton | 7:a94ba2e0cd04 | 283 | spi->write(0xf0); |
| SeanNewton | 7:a94ba2e0cd04 | 284 | spi->write(addr >> 8); |
| SeanNewton | 7:a94ba2e0cd04 | 285 | spi->write(addr & 0xff); |
| SeanNewton | 7:a94ba2e0cd04 | 286 | addr++; |
| SeanNewton | 7:a94ba2e0cd04 | 287 | spi->write(buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 288 | cs = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 289 | } |
| SeanNewton | 7:a94ba2e0cd04 | 290 | #if DBG_SPI |
| SeanNewton | 7:a94ba2e0cd04 | 291 | debug("[SPI]W %04x(%d)", addr, len); |
| SeanNewton | 7:a94ba2e0cd04 | 292 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 293 | debug(" %02x", buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 294 | if (i > 16) { |
| SeanNewton | 7:a94ba2e0cd04 | 295 | debug(" ..."); |
| SeanNewton | 7:a94ba2e0cd04 | 296 | break; |
| SeanNewton | 7:a94ba2e0cd04 | 297 | } |
| SeanNewton | 7:a94ba2e0cd04 | 298 | } |
| SeanNewton | 7:a94ba2e0cd04 | 299 | debug("\r\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 300 | #endif |
| SeanNewton | 7:a94ba2e0cd04 | 301 | } |
| SeanNewton | 7:a94ba2e0cd04 | 302 | |
| SeanNewton | 7:a94ba2e0cd04 | 303 | void WIZnet_Chip::spi_read(uint16_t addr, uint8_t *buf, uint16_t len) |
| SeanNewton | 7:a94ba2e0cd04 | 304 | { |
| SeanNewton | 7:a94ba2e0cd04 | 305 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 306 | cs = 0; |
| SeanNewton | 7:a94ba2e0cd04 | 307 | spi->write(0x0f); |
| SeanNewton | 7:a94ba2e0cd04 | 308 | spi->write(addr >> 8); |
| SeanNewton | 7:a94ba2e0cd04 | 309 | spi->write(addr & 0xff); |
| SeanNewton | 7:a94ba2e0cd04 | 310 | addr++; |
| SeanNewton | 7:a94ba2e0cd04 | 311 | buf[i] = spi->write(0); |
| SeanNewton | 7:a94ba2e0cd04 | 312 | cs = 1; |
| SeanNewton | 7:a94ba2e0cd04 | 313 | } |
| SeanNewton | 7:a94ba2e0cd04 | 314 | #if DBG_SPI |
| SeanNewton | 7:a94ba2e0cd04 | 315 | debug("[SPI]R %04x(%d)", addr, len); |
| SeanNewton | 7:a94ba2e0cd04 | 316 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 317 | debug(" %02x", buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 318 | if (i > 16) { |
| SeanNewton | 7:a94ba2e0cd04 | 319 | debug(" ..."); |
| SeanNewton | 7:a94ba2e0cd04 | 320 | break; |
| SeanNewton | 7:a94ba2e0cd04 | 321 | } |
| SeanNewton | 7:a94ba2e0cd04 | 322 | } |
| SeanNewton | 7:a94ba2e0cd04 | 323 | debug("\r\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 324 | if ((addr&0xf0ff)==0x4026 || (addr&0xf0ff)==0x4003) { |
| SeanNewton | 7:a94ba2e0cd04 | 325 | wait_ms(200); |
| SeanNewton | 7:a94ba2e0cd04 | 326 | } |
| SeanNewton | 7:a94ba2e0cd04 | 327 | #endif |
| SeanNewton | 7:a94ba2e0cd04 | 328 | } |
| SeanNewton | 7:a94ba2e0cd04 | 329 | |
| SeanNewton | 7:a94ba2e0cd04 | 330 | uint32_t str_to_ip(const char* str) |
| SeanNewton | 7:a94ba2e0cd04 | 331 | { |
| SeanNewton | 7:a94ba2e0cd04 | 332 | uint32_t ip = 0; |
| SeanNewton | 7:a94ba2e0cd04 | 333 | char* p = (char*)str; |
| SeanNewton | 7:a94ba2e0cd04 | 334 | for(int i = 0; i < 4; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 335 | ip |= atoi(p); |
| SeanNewton | 7:a94ba2e0cd04 | 336 | p = strchr(p, '.'); |
| SeanNewton | 7:a94ba2e0cd04 | 337 | if (p == NULL) { |
| SeanNewton | 7:a94ba2e0cd04 | 338 | break; |
| SeanNewton | 7:a94ba2e0cd04 | 339 | } |
| SeanNewton | 7:a94ba2e0cd04 | 340 | ip <<= 8; |
| SeanNewton | 7:a94ba2e0cd04 | 341 | p++; |
| SeanNewton | 7:a94ba2e0cd04 | 342 | } |
| SeanNewton | 7:a94ba2e0cd04 | 343 | return ip; |
| SeanNewton | 7:a94ba2e0cd04 | 344 | } |
| SeanNewton | 7:a94ba2e0cd04 | 345 | |
| SeanNewton | 7:a94ba2e0cd04 | 346 | void printfBytes(char* str, uint8_t* buf, int len) |
| SeanNewton | 7:a94ba2e0cd04 | 347 | { |
| SeanNewton | 7:a94ba2e0cd04 | 348 | printf("%s %d:", str, len); |
| SeanNewton | 7:a94ba2e0cd04 | 349 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 350 | printf(" %02x", buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 351 | } |
| SeanNewton | 7:a94ba2e0cd04 | 352 | printf("\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 353 | } |
| SeanNewton | 7:a94ba2e0cd04 | 354 | |
| SeanNewton | 7:a94ba2e0cd04 | 355 | void printHex(uint8_t* buf, int len) |
| SeanNewton | 7:a94ba2e0cd04 | 356 | { |
| SeanNewton | 7:a94ba2e0cd04 | 357 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 358 | if ((i%16) == 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 359 | printf("%p", buf+i); |
| SeanNewton | 7:a94ba2e0cd04 | 360 | } |
| SeanNewton | 7:a94ba2e0cd04 | 361 | printf(" %02x", buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 362 | if ((i%16) == 15) { |
| SeanNewton | 7:a94ba2e0cd04 | 363 | printf("\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 364 | } |
| SeanNewton | 7:a94ba2e0cd04 | 365 | } |
| SeanNewton | 7:a94ba2e0cd04 | 366 | printf("\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 367 | } |
| SeanNewton | 7:a94ba2e0cd04 | 368 | |
| SeanNewton | 7:a94ba2e0cd04 | 369 | void debug_hex(uint8_t* buf, int len) |
| SeanNewton | 7:a94ba2e0cd04 | 370 | { |
| SeanNewton | 7:a94ba2e0cd04 | 371 | for(int i = 0; i < len; i++) { |
| SeanNewton | 7:a94ba2e0cd04 | 372 | if ((i%16) == 0) { |
| SeanNewton | 7:a94ba2e0cd04 | 373 | debug("%p", buf+i); |
| SeanNewton | 7:a94ba2e0cd04 | 374 | } |
| SeanNewton | 7:a94ba2e0cd04 | 375 | debug(" %02x", buf[i]); |
| SeanNewton | 7:a94ba2e0cd04 | 376 | if ((i%16) == 15) { |
| SeanNewton | 7:a94ba2e0cd04 | 377 | debug("\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 378 | } |
| SeanNewton | 7:a94ba2e0cd04 | 379 | } |
| SeanNewton | 7:a94ba2e0cd04 | 380 | debug("\n"); |
| SeanNewton | 7:a94ba2e0cd04 | 381 | } |
| SeanNewton | 7:a94ba2e0cd04 | 382 | |
| SeanNewton | 7:a94ba2e0cd04 | 383 | #endif |
