Helmut Tschemernjak / WIZnetInterface

WIZNet W5500 with additional enhancements

Fork of WIZnetInterface by WIZnet

arch/int/W7500x_toe.cpp@0:6f28332c466f, 2015-06-15 (annotated)

Committer:
Soohwan Kim
Date:
Mon Jun 15 11:18:37 2015 +0900
Revision:
0:6f28332c466f
Child:
2:26df0dc6e227
initial version

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Soohwan Kim 0:6f28332c466f 1 /* Copyright (C) 2012 mbed.org, MIT License
Soohwan Kim 0:6f28332c466f 2 *
Soohwan Kim 0:6f28332c466f 3 * and associated documentation files (the "Software"), to deal in the Software without restriction,
Soohwan Kim 0:6f28332c466f 4 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
Soohwan Kim 0:6f28332c466f 5 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
Soohwan Kim 0:6f28332c466f 6 * furnished to do so, subject to the following conditions:
Soohwan Kim 0:6f28332c466f 7 *
Soohwan Kim 0:6f28332c466f 8 * The above copyright notice and this permission notice shall be included in all copies or
Soohwan Kim 0:6f28332c466f 9 * substantial portions of the Software.
Soohwan Kim 0:6f28332c466f 10 *
Soohwan Kim 0:6f28332c466f 11 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
Soohwan Kim 0:6f28332c466f 12 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
Soohwan Kim 0:6f28332c466f 13 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
Soohwan Kim 0:6f28332c466f 14 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Soohwan Kim 0:6f28332c466f 15 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Soohwan Kim 0:6f28332c466f 16 */
Soohwan Kim 0:6f28332c466f 17
Soohwan Kim 0:6f28332c466f 18 #include "mbed.h"
Soohwan Kim 0:6f28332c466f 19 #include "mbed_debug.h"
Soohwan Kim 0:6f28332c466f 20 #include "W7500x_toe.h"
Soohwan Kim 0:6f28332c466f 21 #include "DNSClient.h"
Soohwan Kim 0:6f28332c466f 22
Soohwan Kim 0:6f28332c466f 23 #ifdef USE_W7500
Soohwan Kim 0:6f28332c466f 24
Soohwan Kim 0:6f28332c466f 25 /*
Soohwan Kim 0:6f28332c466f 26 * MDIO via GPIO
Soohwan Kim 0:6f28332c466f 27 * mdio via gpio is supported and related functions as follows.
Soohwan Kim 0:6f28332c466f 28 * - mdio_init(),mdio_read(),mdio_write()
Soohwan Kim 0:6f28332c466f 29 * - input_MDIO(),output_MDIO(),turnaroud_MDIO(),idle_MDIO()
Soohwan Kim 0:6f28332c466f 30 * called by ethernet_link() and ethernet_set_link()
Soohwan Kim 0:6f28332c466f 31 */
Soohwan Kim 0:6f28332c466f 32 #define MDIO GPIO_Pin_14
Soohwan Kim 0:6f28332c466f 33 #define MDC GPIO_Pin_15
Soohwan Kim 0:6f28332c466f 34 #define GPIO_MDC GPIOB
Soohwan Kim 0:6f28332c466f 35 #define PHY_ADDR_IP101G 0x07
Soohwan Kim 0:6f28332c466f 36 #define PHY_ADDR PHY_ADDR_IP101G
Soohwan Kim 0:6f28332c466f 37 #define SVAL 0x2 //right shift val = 2
Soohwan Kim 0:6f28332c466f 38 #define PHYREG_CONTROL 0x0 //Control Register address (Contorl basic register)
Soohwan Kim 0:6f28332c466f 39 #define PHYREG_STATUS 0x1 //Status Register address (Status basic register)
Soohwan Kim 0:6f28332c466f 40 #define CNTL_DUPLEX (0x01ul<< 7)
Soohwan Kim 0:6f28332c466f 41 #define CNTL_AUTONEGO (0x01ul<<11)
Soohwan Kim 0:6f28332c466f 42 #define CNTL_SPEED (0x01ul<<12)
Soohwan Kim 0:6f28332c466f 43 #define MDC_WAIT (1)
Soohwan Kim 0:6f28332c466f 44 void mdio_init(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin_MDC, uint16_t GPIO_Pin_MDIO);
Soohwan Kim 0:6f28332c466f 45 void mdio_write(GPIO_TypeDef* GPIOx, uint32_t PhyRegAddr, uint32_t val);
Soohwan Kim 0:6f28332c466f 46 uint32_t mdio_read(GPIO_TypeDef* GPIOx, uint32_t PhyRegAddr);
Soohwan Kim 0:6f28332c466f 47
Soohwan Kim 0:6f28332c466f 48 WIZnet_Chip* WIZnet_Chip::inst;
Soohwan Kim 0:6f28332c466f 49
Soohwan Kim 0:6f28332c466f 50 WIZnet_Chip::WIZnet_Chip()
Soohwan Kim 0:6f28332c466f 51 {
Soohwan Kim 0:6f28332c466f 52 inst = this;
Soohwan Kim 0:6f28332c466f 53 mdio_init(GPIO_MDC, MDC, MDIO);
Soohwan Kim 0:6f28332c466f 54 }
Soohwan Kim 0:6f28332c466f 55
Soohwan Kim 0:6f28332c466f 56 // Set the IP
Soohwan Kim 0:6f28332c466f 57 bool WIZnet_Chip::setip()
Soohwan Kim 0:6f28332c466f 58 {
Soohwan Kim 0:6f28332c466f 59 reg_wr<uint32_t>(SIPR, ip);
Soohwan Kim 0:6f28332c466f 60 reg_wr<uint32_t>(GAR, gateway);
Soohwan Kim 0:6f28332c466f 61 reg_wr<uint32_t>(SUBR, netmask);
Soohwan Kim 0:6f28332c466f 62 return true;
Soohwan Kim 0:6f28332c466f 63 }
Soohwan Kim 0:6f28332c466f 64
Soohwan Kim 0:6f28332c466f 65 bool WIZnet_Chip::setProtocol(int socket, Protocol p)
Soohwan Kim 0:6f28332c466f 66 {
Soohwan Kim 0:6f28332c466f 67 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 68 return false;
Soohwan Kim 0:6f28332c466f 69 }
Soohwan Kim 0:6f28332c466f 70 sreg<uint8_t>(socket, Sn_MR, p);
Soohwan Kim 0:6f28332c466f 71 return true;
Soohwan Kim 0:6f28332c466f 72 }
Soohwan Kim 0:6f28332c466f 73
Soohwan Kim 0:6f28332c466f 74 bool WIZnet_Chip::connect(int socket, const char * host, int port, int timeout_ms)
Soohwan Kim 0:6f28332c466f 75 {
Soohwan Kim 0:6f28332c466f 76 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 77 return false;
Soohwan Kim 0:6f28332c466f 78 }
Soohwan Kim 0:6f28332c466f 79 sreg<uint8_t>(socket, Sn_MR, TCP);
Soohwan Kim 0:6f28332c466f 80 scmd(socket, OPEN);
Soohwan Kim 0:6f28332c466f 81 sreg_ip(socket, Sn_DIPR, host);
Soohwan Kim 0:6f28332c466f 82 sreg<uint16_t>(socket, Sn_DPORT, port);
Soohwan Kim 0:6f28332c466f 83 sreg<uint16_t>(socket, Sn_PORT, new_port());
Soohwan Kim 0:6f28332c466f 84 scmd(socket, CONNECT);
Soohwan Kim 0:6f28332c466f 85 Timer t;
Soohwan Kim 0:6f28332c466f 86 t.reset();
Soohwan Kim 0:6f28332c466f 87 t.start();
Soohwan Kim 0:6f28332c466f 88 while(!is_connected(socket)) {
Soohwan Kim 0:6f28332c466f 89 if (t.read_ms() > timeout_ms) {
Soohwan Kim 0:6f28332c466f 90 return false;
Soohwan Kim 0:6f28332c466f 91 }
Soohwan Kim 0:6f28332c466f 92 }
Soohwan Kim 0:6f28332c466f 93 return true;
Soohwan Kim 0:6f28332c466f 94 }
Soohwan Kim 0:6f28332c466f 95
Soohwan Kim 0:6f28332c466f 96 bool WIZnet_Chip::gethostbyname(const char* host, uint32_t* ip)
Soohwan Kim 0:6f28332c466f 97 {
Soohwan Kim 0:6f28332c466f 98 uint32_t addr = str_to_ip(host);
Soohwan Kim 0:6f28332c466f 99 char buf[17];
Soohwan Kim 0:6f28332c466f 100 snprintf(buf, sizeof(buf), "%d.%d.%d.%d",
Soohwan Kim 0:6f28332c466f 101 (uint8_t)((addr>>24)&0xff),
Soohwan Kim 0:6f28332c466f 102 (uint8_t)((addr>>16)&0xff),
Soohwan Kim 0:6f28332c466f 103 (uint8_t)((addr>>8)&0xff),
Soohwan Kim 0:6f28332c466f 104 (uint8_t)(addr&0xff));
Soohwan Kim 0:6f28332c466f 105 if (strcmp(buf, host) == 0) {
Soohwan Kim 0:6f28332c466f 106 *ip = addr;
Soohwan Kim 0:6f28332c466f 107 printf("addr : %x\r\n", *ip);
Soohwan Kim 0:6f28332c466f 108 return true;
Soohwan Kim 0:6f28332c466f 109 }
Soohwan Kim 0:6f28332c466f 110 DNSClient client;
Soohwan Kim 0:6f28332c466f 111 if(client.lookup(host)) {
Soohwan Kim 0:6f28332c466f 112 *ip = client.ip;
Soohwan Kim 0:6f28332c466f 113 return true;
Soohwan Kim 0:6f28332c466f 114 }
Soohwan Kim 0:6f28332c466f 115 return false;
Soohwan Kim 0:6f28332c466f 116 }
Soohwan Kim 0:6f28332c466f 117
Soohwan Kim 0:6f28332c466f 118
Soohwan Kim 0:6f28332c466f 119 bool WIZnet_Chip::is_connected(int socket)
Soohwan Kim 0:6f28332c466f 120 {
Soohwan Kim 0:6f28332c466f 121 /*
Soohwan Kim 0:6f28332c466f 122 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_ESTABLISHED) {
Soohwan Kim 0:6f28332c466f 123 return true;
Soohwan Kim 0:6f28332c466f 124 }
Soohwan Kim 0:6f28332c466f 125 */
Soohwan Kim 0:6f28332c466f 126 uint8_t tmpSn_SR;
Soohwan Kim 0:6f28332c466f 127 tmpSn_SR = sreg<uint8_t>(socket, Sn_SR);
Soohwan Kim 0:6f28332c466f 128 // packet sending is possible, when state is SOCK_CLOSE_WAIT.
Soohwan Kim 0:6f28332c466f 129 if ((tmpSn_SR == SOCK_ESTABLISHED) || (tmpSn_SR == SOCK_CLOSE_WAIT)) {
Soohwan Kim 0:6f28332c466f 130 return true;
Soohwan Kim 0:6f28332c466f 131 }
Soohwan Kim 0:6f28332c466f 132 return false;
Soohwan Kim 0:6f28332c466f 133 }
Soohwan Kim 0:6f28332c466f 134 // Reset the chip & set the buffer
Soohwan Kim 0:6f28332c466f 135 void WIZnet_Chip::reset()
Soohwan Kim 0:6f28332c466f 136 {
Soohwan Kim 0:6f28332c466f 137 /* S/W Reset PHY */
Soohwan Kim 0:6f28332c466f 138 mdio_write(GPIO_MDC, PHYREG_CONTROL, 0x8000);
Soohwan Kim 0:6f28332c466f 139 wait_ms(10);//for S/W reset
Soohwan Kim 0:6f28332c466f 140 wait_ms(10);//for MDC I/F RDY
Soohwan Kim 0:6f28332c466f 141
Soohwan Kim 0:6f28332c466f 142 /* S/W Reset WZTOE */
Soohwan Kim 0:6f28332c466f 143 reg_wr<uint8_t>(MR, MR_RST);
Soohwan Kim 0:6f28332c466f 144 // set PAD strengh and pull-up for TXD[3:0] and TXE
Soohwan Kim 0:6f28332c466f 145 #ifdef __DEF_USED_IC101AG__ //For using IC+101AG
Soohwan Kim 0:6f28332c466f 146 *(volatile uint32_t *)(0x41003068) = 0x64; //TXD0
Soohwan Kim 0:6f28332c466f 147 *(volatile uint32_t *)(0x4100306C) = 0x64; //TXD1
Soohwan Kim 0:6f28332c466f 148 *(volatile uint32_t *)(0x41003070) = 0x64; //TXD2
Soohwan Kim 0:6f28332c466f 149 *(volatile uint32_t *)(0x41003074) = 0x64; //TXD3
Soohwan Kim 0:6f28332c466f 150 *(volatile uint32_t *)(0x41003050) = 0x64; //TXE
Soohwan Kim 0:6f28332c466f 151 #endif
Soohwan Kim 0:6f28332c466f 152 // set ticker counter
Soohwan Kim 0:6f28332c466f 153 reg_wr<uint32_t>(TIC100US, (SystemCoreClock/10000));
Soohwan Kim 0:6f28332c466f 154 // write MAC address inside the WZTOE MAC address register
Soohwan Kim 0:6f28332c466f 155 reg_wr_mac(SHAR, mac);
Soohwan Kim 0:6f28332c466f 156 /*
Soohwan Kim 0:6f28332c466f 157 * set RX and TX buffer size
Soohwan Kim 0:6f28332c466f 158 * for (int socket = 0; socket < MAX_SOCK_NUM; socket++) {
Soohwan Kim 0:6f28332c466f 159 * sreg<uint8_t>(socket, Sn_RXBUF_SIZE, 2);
Soohwan Kim 0:6f28332c466f 160 * sreg<uint8_t>(socket, Sn_TXBUF_SIZE, 2);
Soohwan Kim 0:6f28332c466f 161 * }
Soohwan Kim 0:6f28332c466f 162 */
Soohwan Kim 0:6f28332c466f 163 }
Soohwan Kim 0:6f28332c466f 164
Soohwan Kim 0:6f28332c466f 165
Soohwan Kim 0:6f28332c466f 166 bool WIZnet_Chip::close(int socket)
Soohwan Kim 0:6f28332c466f 167 {
Soohwan Kim 0:6f28332c466f 168 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 169 return false;
Soohwan Kim 0:6f28332c466f 170 }
Soohwan Kim 0:6f28332c466f 171 // if SOCK_CLOSED, return
Soohwan Kim 0:6f28332c466f 172 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
Soohwan Kim 0:6f28332c466f 173 return true;
Soohwan Kim 0:6f28332c466f 174 }
Soohwan Kim 0:6f28332c466f 175 // if SOCK_ESTABLISHED, send FIN-Packet to peer
Soohwan Kim 0:6f28332c466f 176 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
Soohwan Kim 0:6f28332c466f 177 scmd(socket, DISCON);
Soohwan Kim 0:6f28332c466f 178 }
Soohwan Kim 0:6f28332c466f 179 // close socket
Soohwan Kim 0:6f28332c466f 180 scmd(socket, CLOSE);
Soohwan Kim 0:6f28332c466f 181 // clear Socket Interrupt Register
Soohwan Kim 0:6f28332c466f 182 sreg<uint8_t>(socket, Sn_ICR, 0xff);
Soohwan Kim 0:6f28332c466f 183 return true;
Soohwan Kim 0:6f28332c466f 184 }
Soohwan Kim 0:6f28332c466f 185
Soohwan Kim 0:6f28332c466f 186 int WIZnet_Chip::wait_readable(int socket, int wait_time_ms, int req_size)
Soohwan Kim 0:6f28332c466f 187 {
Soohwan Kim 0:6f28332c466f 188 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 189 return -1;
Soohwan Kim 0:6f28332c466f 190 }
Soohwan Kim 0:6f28332c466f 191 Timer t;
Soohwan Kim 0:6f28332c466f 192 t.reset();
Soohwan Kim 0:6f28332c466f 193 t.start();
Soohwan Kim 0:6f28332c466f 194 while(1) {
Soohwan Kim 0:6f28332c466f 195 int size = sreg<uint16_t>(socket, Sn_RX_RSR);
Soohwan Kim 0:6f28332c466f 196 if (size > req_size) {
Soohwan Kim 0:6f28332c466f 197 return size;
Soohwan Kim 0:6f28332c466f 198 }
Soohwan Kim 0:6f28332c466f 199 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
Soohwan Kim 0:6f28332c466f 200 break;
Soohwan Kim 0:6f28332c466f 201 }
Soohwan Kim 0:6f28332c466f 202 }
Soohwan Kim 0:6f28332c466f 203 return -1;
Soohwan Kim 0:6f28332c466f 204 }
Soohwan Kim 0:6f28332c466f 205
Soohwan Kim 0:6f28332c466f 206 int WIZnet_Chip::wait_writeable(int socket, int wait_time_ms, int req_size)
Soohwan Kim 0:6f28332c466f 207 {
Soohwan Kim 0:6f28332c466f 208 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 209 return -1;
Soohwan Kim 0:6f28332c466f 210 }
Soohwan Kim 0:6f28332c466f 211 Timer t;
Soohwan Kim 0:6f28332c466f 212 t.reset();
Soohwan Kim 0:6f28332c466f 213 t.start();
Soohwan Kim 0:6f28332c466f 214 while(1) {
Soohwan Kim 0:6f28332c466f 215 int size = sreg<uint16_t>(socket, Sn_TX_FSR);
Soohwan Kim 0:6f28332c466f 216 if (size > req_size) {
Soohwan Kim 0:6f28332c466f 217 return size;
Soohwan Kim 0:6f28332c466f 218 }
Soohwan Kim 0:6f28332c466f 219 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
Soohwan Kim 0:6f28332c466f 220 break;
Soohwan Kim 0:6f28332c466f 221 }
Soohwan Kim 0:6f28332c466f 222 }
Soohwan Kim 0:6f28332c466f 223 return -1;
Soohwan Kim 0:6f28332c466f 224 }
Soohwan Kim 0:6f28332c466f 225
Soohwan Kim 0:6f28332c466f 226 int WIZnet_Chip::send(int socket, const char * str, int len)
Soohwan Kim 0:6f28332c466f 227 {
Soohwan Kim 0:6f28332c466f 228 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 229 return -1;
Soohwan Kim 0:6f28332c466f 230 }
Soohwan Kim 0:6f28332c466f 231
Soohwan Kim 0:6f28332c466f 232 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
Soohwan Kim 0:6f28332c466f 233 uint32_t sn_tx_base = W7500x_TXMEM_BASE + (uint32_t)(socket<<18);
Soohwan Kim 0:6f28332c466f 234
Soohwan Kim 0:6f28332c466f 235 for(int i=0; i<len; i++)
Soohwan Kim 0:6f28332c466f 236 *(volatile uint8_t *)(sn_tx_base + ((ptr+i)&0xFFFF)) = str[i];
Soohwan Kim 0:6f28332c466f 237
Soohwan Kim 0:6f28332c466f 238 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
Soohwan Kim 0:6f28332c466f 239 scmd(socket, SEND);
Soohwan Kim 0:6f28332c466f 240
Soohwan Kim 0:6f28332c466f 241 uint8_t tmp_Sn_IR;
Soohwan Kim 0:6f28332c466f 242 while (( (tmp_Sn_IR = sreg<uint8_t>(socket, Sn_IR)) & INT_SEND_OK) != INT_SEND_OK) {
Soohwan Kim 0:6f28332c466f 243 // @Jul.10, 2014 fix contant name, and udp sendto function.
Soohwan Kim 0:6f28332c466f 244 switch (sreg<uint8_t>(socket, Sn_SR)) {
Soohwan Kim 0:6f28332c466f 245 case SOCK_CLOSED :
Soohwan Kim 0:6f28332c466f 246 close(socket);
Soohwan Kim 0:6f28332c466f 247 return 0;
Soohwan Kim 0:6f28332c466f 248 //break;
Soohwan Kim 0:6f28332c466f 249 case SOCK_UDP :
Soohwan Kim 0:6f28332c466f 250 // ARP timeout is possible.
Soohwan Kim 0:6f28332c466f 251 if ((tmp_Sn_IR & INT_TIMEOUT) == INT_TIMEOUT) {
Soohwan Kim 0:6f28332c466f 252 sreg<uint8_t>(socket, Sn_ICR, INT_TIMEOUT);
Soohwan Kim 0:6f28332c466f 253 return 0;
Soohwan Kim 0:6f28332c466f 254 }
Soohwan Kim 0:6f28332c466f 255 break;
Soohwan Kim 0:6f28332c466f 256 default :
Soohwan Kim 0:6f28332c466f 257 break;
Soohwan Kim 0:6f28332c466f 258 }
Soohwan Kim 0:6f28332c466f 259 }
Soohwan Kim 0:6f28332c466f 260
Soohwan Kim 0:6f28332c466f 261 sreg<uint8_t>(socket, Sn_ICR, INT_SEND_OK);
Soohwan Kim 0:6f28332c466f 262
Soohwan Kim 0:6f28332c466f 263 return len;
Soohwan Kim 0:6f28332c466f 264 }
Soohwan Kim 0:6f28332c466f 265
Soohwan Kim 0:6f28332c466f 266 int WIZnet_Chip::recv(int socket, char* buf, int len)
Soohwan Kim 0:6f28332c466f 267 {
Soohwan Kim 0:6f28332c466f 268 if (socket < 0) {
Soohwan Kim 0:6f28332c466f 269 return -1;
Soohwan Kim 0:6f28332c466f 270 }
Soohwan Kim 0:6f28332c466f 271 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
Soohwan Kim 0:6f28332c466f 272 uint32_t sn_rx_base = W7500x_RXMEM_BASE + (uint32_t)(socket<<18);
Soohwan Kim 0:6f28332c466f 273
Soohwan Kim 0:6f28332c466f 274 for(int i=0; i<len; i++)
Soohwan Kim 0:6f28332c466f 275 buf[i] = *(volatile uint8_t *)(sn_rx_base + ((ptr+i)&0xFFFF));
Soohwan Kim 0:6f28332c466f 276
Soohwan Kim 0:6f28332c466f 277 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
Soohwan Kim 0:6f28332c466f 278 scmd(socket, RECV);
Soohwan Kim 0:6f28332c466f 279
Soohwan Kim 0:6f28332c466f 280 return len;
Soohwan Kim 0:6f28332c466f 281 }
Soohwan Kim 0:6f28332c466f 282
Soohwan Kim 0:6f28332c466f 283 int WIZnet_Chip::new_socket()
Soohwan Kim 0:6f28332c466f 284 {
Soohwan Kim 0:6f28332c466f 285 for(int s = 0; s < MAX_SOCK_NUM; s++) {
Soohwan Kim 0:6f28332c466f 286 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
Soohwan Kim 0:6f28332c466f 287 return s;
Soohwan Kim 0:6f28332c466f 288 }
Soohwan Kim 0:6f28332c466f 289 }
Soohwan Kim 0:6f28332c466f 290 return -1;
Soohwan Kim 0:6f28332c466f 291 }
Soohwan Kim 0:6f28332c466f 292
Soohwan Kim 0:6f28332c466f 293 uint16_t WIZnet_Chip::new_port()
Soohwan Kim 0:6f28332c466f 294 {
Soohwan Kim 0:6f28332c466f 295 uint16_t port = rand();
Soohwan Kim 0:6f28332c466f 296 port |= 49152;
Soohwan Kim 0:6f28332c466f 297 return port;
Soohwan Kim 0:6f28332c466f 298 }
Soohwan Kim 0:6f28332c466f 299
Soohwan Kim 0:6f28332c466f 300 bool WIZnet_Chip::link(int wait_time_ms)
Soohwan Kim 0:6f28332c466f 301 {
Soohwan Kim 0:6f28332c466f 302 Timer t;
Soohwan Kim 0:6f28332c466f 303 t.reset();
Soohwan Kim 0:6f28332c466f 304 t.start();
Soohwan Kim 0:6f28332c466f 305 while(1) {
Soohwan Kim 0:6f28332c466f 306 int is_link = ethernet_link();
Soohwan Kim 0:6f28332c466f 307 printf("is_link:%d\r\n", is_link);
Soohwan Kim 0:6f28332c466f 308 if (is_link) {
Soohwan Kim 0:6f28332c466f 309 return true;
Soohwan Kim 0:6f28332c466f 310 }
Soohwan Kim 0:6f28332c466f 311 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
Soohwan Kim 0:6f28332c466f 312 break;
Soohwan Kim 0:6f28332c466f 313 }
Soohwan Kim 0:6f28332c466f 314 }
Soohwan Kim 0:6f28332c466f 315 return 0;
Soohwan Kim 0:6f28332c466f 316 }
Soohwan Kim 0:6f28332c466f 317
Soohwan Kim 0:6f28332c466f 318 void WIZnet_Chip::set_link(PHYMode phymode)
Soohwan Kim 0:6f28332c466f 319 {
Soohwan Kim 0:6f28332c466f 320 int speed = -1;
Soohwan Kim 0:6f28332c466f 321 int duplex = 0;
Soohwan Kim 0:6f28332c466f 322
Soohwan Kim 0:6f28332c466f 323 switch(phymode) {
Soohwan Kim 0:6f28332c466f 324 case AutoNegotiate : speed = -1; duplex = 0; break;
Soohwan Kim 0:6f28332c466f 325 case HalfDuplex10 : speed = 0; duplex = 0; break;
Soohwan Kim 0:6f28332c466f 326 case FullDuplex10 : speed = 0; duplex = 1; break;
Soohwan Kim 0:6f28332c466f 327 case HalfDuplex100 : speed = 1; duplex = 0; break;
Soohwan Kim 0:6f28332c466f 328 case FullDuplex100 : speed = 1; duplex = 1; break;
Soohwan Kim 0:6f28332c466f 329 }
Soohwan Kim 0:6f28332c466f 330
Soohwan Kim 0:6f28332c466f 331 ethernet_set_link(speed, duplex);
Soohwan Kim 0:6f28332c466f 332 }
Soohwan Kim 0:6f28332c466f 333
Soohwan Kim 0:6f28332c466f 334 uint32_t str_to_ip(const char* str)
Soohwan Kim 0:6f28332c466f 335 {
Soohwan Kim 0:6f28332c466f 336 uint32_t ip = 0;
Soohwan Kim 0:6f28332c466f 337 char* p = (char*)str;
Soohwan Kim 0:6f28332c466f 338 for(int i = 0; i < 4; i++) {
Soohwan Kim 0:6f28332c466f 339 ip |= atoi(p);
Soohwan Kim 0:6f28332c466f 340 p = strchr(p, '.');
Soohwan Kim 0:6f28332c466f 341 if (p == NULL) {
Soohwan Kim 0:6f28332c466f 342 break;
Soohwan Kim 0:6f28332c466f 343 }
Soohwan Kim 0:6f28332c466f 344 ip <<= 8;
Soohwan Kim 0:6f28332c466f 345 p++;
Soohwan Kim 0:6f28332c466f 346 }
Soohwan Kim 0:6f28332c466f 347 return ip;
Soohwan Kim 0:6f28332c466f 348 }
Soohwan Kim 0:6f28332c466f 349
Soohwan Kim 0:6f28332c466f 350 void printfBytes(char* str, uint8_t* buf, int len)
Soohwan Kim 0:6f28332c466f 351 {
Soohwan Kim 0:6f28332c466f 352 printf("%s %d:", str, len);
Soohwan Kim 0:6f28332c466f 353 for(int i = 0; i < len; i++) {
Soohwan Kim 0:6f28332c466f 354 printf(" %02x", buf[i]);
Soohwan Kim 0:6f28332c466f 355 }
Soohwan Kim 0:6f28332c466f 356 printf("\n");
Soohwan Kim 0:6f28332c466f 357 }
Soohwan Kim 0:6f28332c466f 358
Soohwan Kim 0:6f28332c466f 359 void printHex(uint8_t* buf, int len)
Soohwan Kim 0:6f28332c466f 360 {
Soohwan Kim 0:6f28332c466f 361 for(int i = 0; i < len; i++) {
Soohwan Kim 0:6f28332c466f 362 if ((i%16) == 0) {
Soohwan Kim 0:6f28332c466f 363 printf("%p", buf+i);
Soohwan Kim 0:6f28332c466f 364 }
Soohwan Kim 0:6f28332c466f 365 printf(" %02x", buf[i]);
Soohwan Kim 0:6f28332c466f 366 if ((i%16) == 15) {
Soohwan Kim 0:6f28332c466f 367 printf("\n");
Soohwan Kim 0:6f28332c466f 368 }
Soohwan Kim 0:6f28332c466f 369 }
Soohwan Kim 0:6f28332c466f 370 printf("\n");
Soohwan Kim 0:6f28332c466f 371 }
Soohwan Kim 0:6f28332c466f 372
Soohwan Kim 0:6f28332c466f 373 void debug_hex(uint8_t* buf, int len)
Soohwan Kim 0:6f28332c466f 374 {
Soohwan Kim 0:6f28332c466f 375 for(int i = 0; i < len; i++) {
Soohwan Kim 0:6f28332c466f 376 if ((i%16) == 0) {
Soohwan Kim 0:6f28332c466f 377 debug("%p", buf+i);
Soohwan Kim 0:6f28332c466f 378 }
Soohwan Kim 0:6f28332c466f 379 debug(" %02x", buf[i]);
Soohwan Kim 0:6f28332c466f 380 if ((i%16) == 15) {
Soohwan Kim 0:6f28332c466f 381 debug("\n");
Soohwan Kim 0:6f28332c466f 382 }
Soohwan Kim 0:6f28332c466f 383 }
Soohwan Kim 0:6f28332c466f 384 debug("\n");
Soohwan Kim 0:6f28332c466f 385 }
Soohwan Kim 0:6f28332c466f 386
Soohwan Kim 0:6f28332c466f 387 void WIZnet_Chip::scmd(int socket, Command cmd)
Soohwan Kim 0:6f28332c466f 388 {
Soohwan Kim 0:6f28332c466f 389 sreg<uint8_t>(socket, Sn_CR, cmd);
Soohwan Kim 0:6f28332c466f 390 while(sreg<uint8_t>(socket, Sn_CR));
Soohwan Kim 0:6f28332c466f 391 }
Soohwan Kim 0:6f28332c466f 392
Soohwan Kim 0:6f28332c466f 393
Soohwan Kim 0:6f28332c466f 394 void mdio_init(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin_MDC, uint16_t GPIO_Pin_MDIO)
Soohwan Kim 0:6f28332c466f 395 {
Soohwan Kim 0:6f28332c466f 396 /* Set GPIOs for MDIO and MDC */
Soohwan Kim 0:6f28332c466f 397 GPIO_InitTypeDef MDIO_InitDef;
Soohwan Kim 0:6f28332c466f 398 HAL_PAD_AFConfig(PAD_PB, GPIO_Pin_MDIO, PAD_AF1);
Soohwan Kim 0:6f28332c466f 399 HAL_PAD_AFConfig(PAD_PB, GPIO_Pin_MDC, PAD_AF1);
Soohwan Kim 0:6f28332c466f 400 MDIO_InitDef.GPIO_Pin = GPIO_Pin_MDC | GPIO_Pin_MDIO;
Soohwan Kim 0:6f28332c466f 401 MDIO_InitDef.GPIO_Mode = GPIO_Mode_OUT;
Soohwan Kim 0:6f28332c466f 402 HAL_GPIO_Init(GPIOx, &MDIO_InitDef);
Soohwan Kim 0:6f28332c466f 403 }
Soohwan Kim 0:6f28332c466f 404
Soohwan Kim 0:6f28332c466f 405 void output_MDIO(GPIO_TypeDef* GPIOx, uint32_t val, uint32_t n)
Soohwan Kim 0:6f28332c466f 406 {
Soohwan Kim 0:6f28332c466f 407 for(val <<= (32-n); n; val<<=1, n--)
Soohwan Kim 0:6f28332c466f 408 {
Soohwan Kim 0:6f28332c466f 409 if(val & 0x80000000)
Soohwan Kim 0:6f28332c466f 410 HAL_GPIO_SetBits(GPIOx, MDIO);
Soohwan Kim 0:6f28332c466f 411 else
Soohwan Kim 0:6f28332c466f 412 HAL_GPIO_ResetBits(GPIOx, MDIO);
Soohwan Kim 0:6f28332c466f 413
Soohwan Kim 0:6f28332c466f 414 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 415 HAL_GPIO_SetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 416 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 417 HAL_GPIO_ResetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 418 }
Soohwan Kim 0:6f28332c466f 419 }
Soohwan Kim 0:6f28332c466f 420
Soohwan Kim 0:6f28332c466f 421 uint32_t input_MDIO( GPIO_TypeDef* GPIOx )
Soohwan Kim 0:6f28332c466f 422 {
Soohwan Kim 0:6f28332c466f 423 uint32_t i, val=0;
Soohwan Kim 0:6f28332c466f 424 for(i=0; i<16; i++)
Soohwan Kim 0:6f28332c466f 425 {
Soohwan Kim 0:6f28332c466f 426 val <<=1;
Soohwan Kim 0:6f28332c466f 427 HAL_GPIO_SetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 428 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 429 HAL_GPIO_ResetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 430 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 431 val |= HAL_GPIO_ReadInputDataBit(GPIOx, MDIO);
Soohwan Kim 0:6f28332c466f 432 }
Soohwan Kim 0:6f28332c466f 433 return (val);
Soohwan Kim 0:6f28332c466f 434 }
Soohwan Kim 0:6f28332c466f 435
Soohwan Kim 0:6f28332c466f 436 void turnaround_MDIO( GPIO_TypeDef* GPIOx)
Soohwan Kim 0:6f28332c466f 437 {
Soohwan Kim 0:6f28332c466f 438 GPIOx->OUTENCLR = MDIO ;
Soohwan Kim 0:6f28332c466f 439 HAL_GPIO_SetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 440 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 441 HAL_GPIO_ResetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 442 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 443 }
Soohwan Kim 0:6f28332c466f 444
Soohwan Kim 0:6f28332c466f 445 void idle_MDIO( GPIO_TypeDef* GPIOx )
Soohwan Kim 0:6f28332c466f 446 {
Soohwan Kim 0:6f28332c466f 447 GPIOx->OUTENSET = MDIO ;
Soohwan Kim 0:6f28332c466f 448 HAL_GPIO_SetBits(GPIOx,MDC);
Soohwan Kim 0:6f28332c466f 449 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 450 HAL_GPIO_ResetBits(GPIOx, MDC);
Soohwan Kim 0:6f28332c466f 451 wait_ms(MDC_WAIT);
Soohwan Kim 0:6f28332c466f 452 }
Soohwan Kim 0:6f28332c466f 453
Soohwan Kim 0:6f28332c466f 454 uint32_t mdio_read(GPIO_TypeDef* GPIOx, uint32_t PhyRegAddr)
Soohwan Kim 0:6f28332c466f 455 {
Soohwan Kim 0:6f28332c466f 456 output_MDIO(GPIOx, 0xFFFFFFFF, 32);
Soohwan Kim 0:6f28332c466f 457 output_MDIO(GPIOx, 0x06, 4);
Soohwan Kim 0:6f28332c466f 458 output_MDIO(GPIOx, PHY_ADDR, 5);
Soohwan Kim 0:6f28332c466f 459 output_MDIO(GPIOx, PhyRegAddr, 5);
Soohwan Kim 0:6f28332c466f 460 turnaround_MDIO(GPIOx);
Soohwan Kim 0:6f28332c466f 461 uint32_t val = input_MDIO(GPIOx );
Soohwan Kim 0:6f28332c466f 462 idle_MDIO(GPIOx);
Soohwan Kim 0:6f28332c466f 463 return val;
Soohwan Kim 0:6f28332c466f 464 }
Soohwan Kim 0:6f28332c466f 465
Soohwan Kim 0:6f28332c466f 466 void mdio_write(GPIO_TypeDef* GPIOx, uint32_t PhyRegAddr, uint32_t val)
Soohwan Kim 0:6f28332c466f 467 {
Soohwan Kim 0:6f28332c466f 468 output_MDIO(GPIOx, 0xFFFFFFFF, 32);
Soohwan Kim 0:6f28332c466f 469 output_MDIO(GPIOx, 0x05, 4);
Soohwan Kim 0:6f28332c466f 470 output_MDIO(GPIOx, PHY_ADDR, 5);
Soohwan Kim 0:6f28332c466f 471 output_MDIO(GPIOx, PhyRegAddr, 5);
Soohwan Kim 0:6f28332c466f 472 output_MDIO(GPIOx, 0x02, 2);
Soohwan Kim 0:6f28332c466f 473 output_MDIO(GPIOx, val, 16);
Soohwan Kim 0:6f28332c466f 474 idle_MDIO(GPIOx);
Soohwan Kim 0:6f28332c466f 475 }
Soohwan Kim 0:6f28332c466f 476
Soohwan Kim 0:6f28332c466f 477 int ethernet_link(void) {
Soohwan Kim 0:6f28332c466f 478 return ((mdio_read(GPIO_MDC, PHYREG_STATUS)>>SVAL)&0x01);
Soohwan Kim 0:6f28332c466f 479 }
Soohwan Kim 0:6f28332c466f 480
Soohwan Kim 0:6f28332c466f 481 void ethernet_set_link(int speed, int duplex) {
Soohwan Kim 0:6f28332c466f 482 uint32_t val=0;
Soohwan Kim 0:6f28332c466f 483 if((speed < 0) || (speed > 1)) {
Soohwan Kim 0:6f28332c466f 484 val = CNTL_AUTONEGO;
Soohwan Kim 0:6f28332c466f 485 } else {
Soohwan Kim 0:6f28332c466f 486 val = ((CNTL_SPEED&(speed<<11))|(CNTL_DUPLEX&(duplex<<7)));
Soohwan Kim 0:6f28332c466f 487 }
Soohwan Kim 0:6f28332c466f 488 mdio_write(GPIO_MDC, PHYREG_CONTROL, val);
Soohwan Kim 0:6f28332c466f 489 }
Soohwan Kim 0:6f28332c466f 490 #endif
Soohwan Kim 0:6f28332c466f 491