Racelogic / Mbed 2 deprecated VIPS_LTC_RAW_IMU

Dependencies:   BufferedSerial FatFileSystemCpp mbed

Committer:
AndyA
Date:
Mon Jul 05 15:30:14 2021 +0000
Revision:
22:0dd9c1b5664a
First pass at adding UDP FreeD output

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AndyA 22:0dd9c1b5664a 1 /* Copyright (C) 2012 mbed.org, MIT License
AndyA 22:0dd9c1b5664a 2 *
AndyA 22:0dd9c1b5664a 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
AndyA 22:0dd9c1b5664a 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
AndyA 22:0dd9c1b5664a 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
AndyA 22:0dd9c1b5664a 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
AndyA 22:0dd9c1b5664a 7 * furnished to do so, subject to the following conditions:
AndyA 22:0dd9c1b5664a 8 *
AndyA 22:0dd9c1b5664a 9 * The above copyright notice and this permission notice shall be included in all copies or
AndyA 22:0dd9c1b5664a 10 * substantial portions of the Software.
AndyA 22:0dd9c1b5664a 11 *
AndyA 22:0dd9c1b5664a 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
AndyA 22:0dd9c1b5664a 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
AndyA 22:0dd9c1b5664a 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
AndyA 22:0dd9c1b5664a 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
AndyA 22:0dd9c1b5664a 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
AndyA 22:0dd9c1b5664a 17 */
AndyA 22:0dd9c1b5664a 18 #include "Socket/Socket.h"
AndyA 22:0dd9c1b5664a 19 #include <cstring>
AndyA 22:0dd9c1b5664a 20
AndyA 22:0dd9c1b5664a 21 using std::memset;
AndyA 22:0dd9c1b5664a 22
AndyA 22:0dd9c1b5664a 23 Socket::Socket() : _sock_fd(-1), _blocking(true), _timeout(1500) {
AndyA 22:0dd9c1b5664a 24
AndyA 22:0dd9c1b5664a 25 }
AndyA 22:0dd9c1b5664a 26
AndyA 22:0dd9c1b5664a 27 void Socket::set_blocking(bool blocking, unsigned int timeout) {
AndyA 22:0dd9c1b5664a 28 _blocking = blocking;
AndyA 22:0dd9c1b5664a 29 _timeout = timeout;
AndyA 22:0dd9c1b5664a 30 }
AndyA 22:0dd9c1b5664a 31
AndyA 22:0dd9c1b5664a 32 int Socket::init_socket(int type) {
AndyA 22:0dd9c1b5664a 33 if (_sock_fd != -1)
AndyA 22:0dd9c1b5664a 34 return -1;
AndyA 22:0dd9c1b5664a 35
AndyA 22:0dd9c1b5664a 36 int fd = lwip_socket(AF_INET, type, 0);
AndyA 22:0dd9c1b5664a 37 if (fd < 0)
AndyA 22:0dd9c1b5664a 38 return -1;
AndyA 22:0dd9c1b5664a 39
AndyA 22:0dd9c1b5664a 40 _sock_fd = fd;
AndyA 22:0dd9c1b5664a 41 return 0;
AndyA 22:0dd9c1b5664a 42 }
AndyA 22:0dd9c1b5664a 43
AndyA 22:0dd9c1b5664a 44 int Socket::set_option(int level, int optname, const void *optval, socklen_t optlen) {
AndyA 22:0dd9c1b5664a 45 return lwip_setsockopt(_sock_fd, level, optname, optval, optlen);
AndyA 22:0dd9c1b5664a 46 }
AndyA 22:0dd9c1b5664a 47
AndyA 22:0dd9c1b5664a 48 int Socket::get_option(int level, int optname, void *optval, socklen_t *optlen) {
AndyA 22:0dd9c1b5664a 49 return lwip_getsockopt(_sock_fd, level, optname, optval, optlen);
AndyA 22:0dd9c1b5664a 50 }
AndyA 22:0dd9c1b5664a 51
AndyA 22:0dd9c1b5664a 52 int Socket::select(struct timeval *timeout, bool read, bool write) {
AndyA 22:0dd9c1b5664a 53 fd_set fdSet;
AndyA 22:0dd9c1b5664a 54 FD_ZERO(&fdSet);
AndyA 22:0dd9c1b5664a 55 FD_SET(_sock_fd, &fdSet);
AndyA 22:0dd9c1b5664a 56
AndyA 22:0dd9c1b5664a 57 fd_set* readset = (read ) ? (&fdSet) : (NULL);
AndyA 22:0dd9c1b5664a 58 fd_set* writeset = (write) ? (&fdSet) : (NULL);
AndyA 22:0dd9c1b5664a 59
AndyA 22:0dd9c1b5664a 60 int ret = lwip_select(FD_SETSIZE, readset, writeset, NULL, timeout);
AndyA 22:0dd9c1b5664a 61 return (ret <= 0 || !FD_ISSET(_sock_fd, &fdSet)) ? (-1) : (0);
AndyA 22:0dd9c1b5664a 62 }
AndyA 22:0dd9c1b5664a 63
AndyA 22:0dd9c1b5664a 64 int Socket::wait_readable(TimeInterval& timeout) {
AndyA 22:0dd9c1b5664a 65 return select(&timeout._time, true, false);
AndyA 22:0dd9c1b5664a 66 }
AndyA 22:0dd9c1b5664a 67
AndyA 22:0dd9c1b5664a 68 int Socket::wait_writable(TimeInterval& timeout) {
AndyA 22:0dd9c1b5664a 69 return select(&timeout._time, false, true);
AndyA 22:0dd9c1b5664a 70 }
AndyA 22:0dd9c1b5664a 71
AndyA 22:0dd9c1b5664a 72 int Socket::close(bool shutdown) {
AndyA 22:0dd9c1b5664a 73 if (_sock_fd < 0)
AndyA 22:0dd9c1b5664a 74 return -1;
AndyA 22:0dd9c1b5664a 75
AndyA 22:0dd9c1b5664a 76 if (shutdown)
AndyA 22:0dd9c1b5664a 77 lwip_shutdown(_sock_fd, SHUT_RDWR);
AndyA 22:0dd9c1b5664a 78 lwip_close(_sock_fd);
AndyA 22:0dd9c1b5664a 79 _sock_fd = -1;
AndyA 22:0dd9c1b5664a 80
AndyA 22:0dd9c1b5664a 81 return 0;
AndyA 22:0dd9c1b5664a 82 }
AndyA 22:0dd9c1b5664a 83
AndyA 22:0dd9c1b5664a 84 Socket::~Socket() {
AndyA 22:0dd9c1b5664a 85 close(); //Don't want to leak
AndyA 22:0dd9c1b5664a 86 }
AndyA 22:0dd9c1b5664a 87
AndyA 22:0dd9c1b5664a 88 TimeInterval::TimeInterval(unsigned int ms) {
AndyA 22:0dd9c1b5664a 89 _time.tv_sec = ms / 1000;
AndyA 22:0dd9c1b5664a 90 _time.tv_usec = (ms - (_time.tv_sec * 1000)) * 1000;
AndyA 22:0dd9c1b5664a 91 }