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 "TCPSocketConnection.h"
jskl 0:5d27c333afa6 20
jskl 0:5d27c333afa6 21 TCPSocketConnection::TCPSocketConnection()
jskl 0:5d27c333afa6 22 {
jskl 0:5d27c333afa6 23 }
jskl 0:5d27c333afa6 24
jskl 0:5d27c333afa6 25 int TCPSocketConnection::connect(const char* host, const int port)
jskl 0:5d27c333afa6 26 {
jskl 0:5d27c333afa6 27 if (_sock_fd < 0) {
jskl 0:5d27c333afa6 28 _sock_fd = eth->new_socket();
jskl 0:5d27c333afa6 29 if (_sock_fd < 0) {
jskl 0:5d27c333afa6 30 return -1;
jskl 0:5d27c333afa6 31 }
jskl 0:5d27c333afa6 32 }
jskl 0:5d27c333afa6 33 if (set_address(host, port) != 0) {
jskl 0:5d27c333afa6 34 return -1;
jskl 0:5d27c333afa6 35 }
jskl 0:5d27c333afa6 36 if (!eth->connect(_sock_fd, get_address(), port)) {
jskl 0:5d27c333afa6 37 return -1;
jskl 0:5d27c333afa6 38 }
jskl 0:5d27c333afa6 39 return 0;
jskl 0:5d27c333afa6 40 }
jskl 0:5d27c333afa6 41
jskl 0:5d27c333afa6 42 bool TCPSocketConnection::is_connected(void)
jskl 0:5d27c333afa6 43 {
jskl 0:5d27c333afa6 44 return eth->is_connected(_sock_fd);
jskl 0:5d27c333afa6 45 }
jskl 0:5d27c333afa6 46
jskl 0:5d27c333afa6 47 int TCPSocketConnection::send(char* data, int length)
jskl 0:5d27c333afa6 48 {
jskl 0:5d27c333afa6 49 int size = eth->wait_writeable(_sock_fd, _blocking ? -1 : _timeout);
jskl 0:5d27c333afa6 50 if (size < 0) {
jskl 0:5d27c333afa6 51 return -1;
jskl 0:5d27c333afa6 52 }
jskl 0:5d27c333afa6 53 if (size > length) {
jskl 0:5d27c333afa6 54 size = length;
jskl 0:5d27c333afa6 55 }
jskl 0:5d27c333afa6 56 return eth->send(_sock_fd, data, size);
jskl 0:5d27c333afa6 57 }
jskl 0:5d27c333afa6 58
jskl 0:5d27c333afa6 59 // -1 if unsuccessful, else number of bytes written
jskl 0:5d27c333afa6 60 int TCPSocketConnection::send_all(char* data, int length)
jskl 0:5d27c333afa6 61 {
jskl 0:5d27c333afa6 62 int writtenLen = 0;
jskl 0:5d27c333afa6 63 while (writtenLen < length) {
jskl 0:5d27c333afa6 64 int size = eth->wait_writeable(_sock_fd, _blocking ? -1 : _timeout);
jskl 0:5d27c333afa6 65 if (size < 0) {
jskl 0:5d27c333afa6 66 return -1;
jskl 0:5d27c333afa6 67 }
jskl 0:5d27c333afa6 68 if (size > (length-writtenLen)) {
jskl 0:5d27c333afa6 69 size = (length-writtenLen);
jskl 0:5d27c333afa6 70 }
jskl 0:5d27c333afa6 71 int ret = eth->send(_sock_fd, data + writtenLen, size);
jskl 0:5d27c333afa6 72 if (ret < 0) {
jskl 0:5d27c333afa6 73 return -1;
jskl 0:5d27c333afa6 74 }
jskl 0:5d27c333afa6 75 writtenLen += ret;
jskl 0:5d27c333afa6 76 }
jskl 0:5d27c333afa6 77 return writtenLen;
jskl 0:5d27c333afa6 78 }
jskl 0:5d27c333afa6 79
jskl 0:5d27c333afa6 80 // -1 if unsuccessful, else number of bytes received
jskl 0:5d27c333afa6 81 int TCPSocketConnection::receive(char* data, int length)
jskl 0:5d27c333afa6 82 {
jskl 0:5d27c333afa6 83 int size = eth->wait_readable(_sock_fd, _blocking ? -1 : _timeout);
jskl 0:5d27c333afa6 84 if (size < 0) {
jskl 0:5d27c333afa6 85 return -1;
jskl 0:5d27c333afa6 86 }
jskl 0:5d27c333afa6 87 if (size > length) {
jskl 0:5d27c333afa6 88 size = length;
jskl 0:5d27c333afa6 89 }
jskl 0:5d27c333afa6 90 return eth->recv(_sock_fd, data, size);
jskl 0:5d27c333afa6 91 }
jskl 0:5d27c333afa6 92
jskl 0:5d27c333afa6 93 // -1 if unsuccessful, else number of bytes received
jskl 0:5d27c333afa6 94 int TCPSocketConnection::receive_all(char* data, int length)
jskl 0:5d27c333afa6 95 {
jskl 0:5d27c333afa6 96 int readLen = 0;
jskl 0:5d27c333afa6 97 while (readLen < length) {
jskl 0:5d27c333afa6 98 int size = eth->wait_readable(_sock_fd, _blocking ? -1 :_timeout);
jskl 0:5d27c333afa6 99 if (size <= 0) {
jskl 0:5d27c333afa6 100 break;
jskl 0:5d27c333afa6 101 }
jskl 0:5d27c333afa6 102 if (size > (length - readLen)) {
jskl 0:5d27c333afa6 103 size = length - readLen;
jskl 0:5d27c333afa6 104 }
jskl 0:5d27c333afa6 105 int ret = eth->recv(_sock_fd, data + readLen, size);
jskl 0:5d27c333afa6 106 if (ret < 0) {
jskl 0:5d27c333afa6 107 return -1;
jskl 0:5d27c333afa6 108 }
jskl 0:5d27c333afa6 109 readLen += ret;
jskl 0:5d27c333afa6 110 }
jskl 0:5d27c333afa6 111 return readLen;
jskl 0:5d27c333afa6 112 }
jskl 0:5d27c333afa6 113