KL25 driver for Tango Control System

Dependencies:   mbed

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 "WIZnetInterface.h"
jskl 0:5d27c333afa6 20 #include "DHCPClient.h"
jskl 0:5d27c333afa6 21
jskl 0:5d27c333afa6 22 WIZnetInterface::WIZnetInterface(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset) :
jskl 0:5d27c333afa6 23 WIZnet_Chip(mosi, miso, sclk, cs, reset)
jskl 0:5d27c333afa6 24 {
jskl 0:5d27c333afa6 25 ip_set = false;
jskl 0:5d27c333afa6 26 }
jskl 0:5d27c333afa6 27
jskl 0:5d27c333afa6 28 WIZnetInterface::WIZnetInterface(SPI* spi, PinName cs, PinName reset) :
jskl 0:5d27c333afa6 29 WIZnet_Chip(spi, cs, reset)
jskl 0:5d27c333afa6 30 {
jskl 0:5d27c333afa6 31 ip_set = false;
jskl 0:5d27c333afa6 32 }
jskl 0:5d27c333afa6 33
jskl 0:5d27c333afa6 34 int WIZnetInterface::init(uint8_t * mac)
jskl 0:5d27c333afa6 35 {
jskl 0:5d27c333afa6 36 dhcp = true;
jskl 0:5d27c333afa6 37 //
jskl 0:5d27c333afa6 38 for (int i =0; i < 6; i++) this->mac[i] = mac[i];
jskl 0:5d27c333afa6 39 //
jskl 0:5d27c333afa6 40 reset();
jskl 0:5d27c333afa6 41 return 0;
jskl 0:5d27c333afa6 42 }
jskl 0:5d27c333afa6 43
jskl 0:5d27c333afa6 44 int WIZnetInterface::init(uint8_t * mac, const char* ip, const char* mask, const char* gateway)
jskl 0:5d27c333afa6 45 {
jskl 0:5d27c333afa6 46 dhcp = false;
jskl 0:5d27c333afa6 47 //
jskl 0:5d27c333afa6 48 for (int i =0; i < 6; i++) this->mac[i] = mac[i];
jskl 0:5d27c333afa6 49 //
jskl 0:5d27c333afa6 50 this->ip = str_to_ip(ip);
jskl 0:5d27c333afa6 51 strcpy(ip_string, ip);
jskl 0:5d27c333afa6 52 ip_set = true;
jskl 0:5d27c333afa6 53 this->netmask = str_to_ip(mask);
jskl 0:5d27c333afa6 54 this->gateway = str_to_ip(gateway);
jskl 0:5d27c333afa6 55 reset();
jskl 0:5d27c333afa6 56 return 0;
jskl 0:5d27c333afa6 57 }
jskl 0:5d27c333afa6 58
jskl 0:5d27c333afa6 59 // Connect Bring the interface up, start DHCP if needed.
jskl 0:5d27c333afa6 60 int WIZnetInterface::connect()
jskl 0:5d27c333afa6 61 {
jskl 0:5d27c333afa6 62 if (dhcp) {
jskl 0:5d27c333afa6 63 int r = IPrenew();
jskl 0:5d27c333afa6 64 if (r < 0) {
jskl 0:5d27c333afa6 65 return r;
jskl 0:5d27c333afa6 66 }
jskl 0:5d27c333afa6 67 }
jskl 0:5d27c333afa6 68
jskl 0:5d27c333afa6 69 if (WIZnet_Chip::setip() == false) return -1;
jskl 0:5d27c333afa6 70 return 0;
jskl 0:5d27c333afa6 71 }
jskl 0:5d27c333afa6 72
jskl 0:5d27c333afa6 73 // Disconnect Bring the interface down.
jskl 0:5d27c333afa6 74 int WIZnetInterface::disconnect()
jskl 0:5d27c333afa6 75 {
jskl 0:5d27c333afa6 76 if (WIZnet_Chip::disconnect() == false) return -1;
jskl 0:5d27c333afa6 77 return 0;
jskl 0:5d27c333afa6 78 }
jskl 0:5d27c333afa6 79
jskl 0:5d27c333afa6 80 char* WIZnetInterface::getIPAddress()
jskl 0:5d27c333afa6 81 {
jskl 0:5d27c333afa6 82 uint32_t ip = reg_rd<uint32_t>(SIPR);
jskl 0:5d27c333afa6 83 snprintf(ip_string, sizeof(ip_string), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
jskl 0:5d27c333afa6 84 return ip_string;
jskl 0:5d27c333afa6 85 }
jskl 0:5d27c333afa6 86
jskl 0:5d27c333afa6 87 char* WIZnetInterface::getNetworkMask()
jskl 0:5d27c333afa6 88 {
jskl 0:5d27c333afa6 89 uint32_t ip = reg_rd<uint32_t>(SUBR);
jskl 0:5d27c333afa6 90 snprintf(mask_string, sizeof(mask_string), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
jskl 0:5d27c333afa6 91 return mask_string;
jskl 0:5d27c333afa6 92 }
jskl 0:5d27c333afa6 93
jskl 0:5d27c333afa6 94 char* WIZnetInterface::getGateway()
jskl 0:5d27c333afa6 95 {
jskl 0:5d27c333afa6 96 uint32_t ip = reg_rd<uint32_t>(GAR);
jskl 0:5d27c333afa6 97 snprintf(gw_string, sizeof(gw_string), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
jskl 0:5d27c333afa6 98 return gw_string;
jskl 0:5d27c333afa6 99 }
jskl 0:5d27c333afa6 100
jskl 0:5d27c333afa6 101 char* WIZnetInterface::getMACAddress()
jskl 0:5d27c333afa6 102 {
jskl 0:5d27c333afa6 103 uint8_t mac[6];
jskl 0:5d27c333afa6 104 reg_rd_mac(SHAR, mac);
jskl 0:5d27c333afa6 105 snprintf(mac_string, sizeof(mac_string), "%02X:%02X:%02X:%02X:%02X:%02X", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
jskl 0:5d27c333afa6 106 return mac_string;
jskl 0:5d27c333afa6 107
jskl 0:5d27c333afa6 108 }
jskl 0:5d27c333afa6 109
jskl 0:5d27c333afa6 110 int WIZnetInterface::IPrenew(int timeout_ms)
jskl 0:5d27c333afa6 111 {
jskl 0:5d27c333afa6 112 DHCPClient dhcp;
jskl 0:5d27c333afa6 113 int err = dhcp.setup(timeout_ms);
jskl 0:5d27c333afa6 114 if (err == (-1)) {
jskl 0:5d27c333afa6 115 return -1;
jskl 0:5d27c333afa6 116 }
jskl 0:5d27c333afa6 117 // printf("Connected, IP: %d.%d.%d.%d\n", dhcp.yiaddr[0], dhcp.yiaddr[1], dhcp.yiaddr[2], dhcp.yiaddr[3]);
jskl 0:5d27c333afa6 118 ip = (dhcp.yiaddr[0] <<24) | (dhcp.yiaddr[1] <<16) | (dhcp.yiaddr[2] <<8) | dhcp.yiaddr[3];
jskl 0:5d27c333afa6 119 gateway = (dhcp.gateway[0]<<24) | (dhcp.gateway[1]<<16) | (dhcp.gateway[2]<<8) | dhcp.gateway[3];
jskl 0:5d27c333afa6 120 netmask = (dhcp.netmask[0]<<24) | (dhcp.netmask[1]<<16) | (dhcp.netmask[2]<<8) | dhcp.netmask[3];
jskl 0:5d27c333afa6 121 dnsaddr = (dhcp.dnsaddr[0]<<24) | (dhcp.dnsaddr[1]<<16) | (dhcp.dnsaddr[2]<<8) | dhcp.dnsaddr[3];
jskl 0:5d27c333afa6 122 return 0;
jskl 0:5d27c333afa6 123 }