[209] | 1 | #include "ShimClient.h"
|
---|
| 2 | #include "trace.h"
|
---|
| 3 | #include <iostream>
|
---|
| 4 | #include <Arduino.h>
|
---|
| 5 | #include <ctime>
|
---|
| 6 |
|
---|
| 7 | extern "C" {
|
---|
| 8 | uint32_t millis(void) {
|
---|
| 9 | return time(0)*1000;
|
---|
| 10 | }
|
---|
| 11 | }
|
---|
| 12 |
|
---|
| 13 | ShimClient::ShimClient() {
|
---|
| 14 | this->responseBuffer = new Buffer();
|
---|
| 15 | this->expectBuffer = new Buffer();
|
---|
| 16 | this->_allowConnect = true;
|
---|
| 17 | this->_connected = false;
|
---|
| 18 | this->_error = false;
|
---|
| 19 | this->expectAnything = true;
|
---|
| 20 | this->_received = 0;
|
---|
| 21 | this->_expectedPort = 0;
|
---|
| 22 | }
|
---|
| 23 |
|
---|
| 24 | int ShimClient::connect(IPAddress ip, uint16_t port) {
|
---|
| 25 | if (this->_allowConnect) {
|
---|
| 26 | this->_connected = true;
|
---|
| 27 | }
|
---|
| 28 | if (this->_expectedPort !=0) {
|
---|
| 29 | // if (memcmp(ip,this->_expectedIP,4) != 0) {
|
---|
| 30 | // TRACE( "ip mismatch\n");
|
---|
| 31 | // this->_error = true;
|
---|
| 32 | // }
|
---|
| 33 | if (port != this->_expectedPort) {
|
---|
| 34 | TRACE( "port mismatch\n");
|
---|
| 35 | this->_error = true;
|
---|
| 36 | }
|
---|
| 37 | }
|
---|
| 38 | return this->_connected;
|
---|
| 39 | }
|
---|
| 40 | int ShimClient::connect(const char *host, uint16_t port) {
|
---|
| 41 | if (this->_allowConnect) {
|
---|
| 42 | this->_connected = true;
|
---|
| 43 | }
|
---|
| 44 | if (this->_expectedPort !=0) {
|
---|
| 45 | if (strcmp(host,this->_expectedHost) != 0) {
|
---|
| 46 | TRACE( "host mismatch\n");
|
---|
| 47 | this->_error = true;
|
---|
| 48 | }
|
---|
| 49 | if (port != this->_expectedPort) {
|
---|
| 50 | TRACE( "port mismatch\n");
|
---|
| 51 | this->_error = true;
|
---|
| 52 | }
|
---|
| 53 |
|
---|
| 54 | }
|
---|
| 55 | return this->_connected;
|
---|
| 56 | }
|
---|
| 57 | size_t ShimClient::write(uint8_t b) {
|
---|
| 58 | this->_received += 1;
|
---|
| 59 | TRACE(std::hex << (unsigned int)b);
|
---|
| 60 | if (!this->expectAnything) {
|
---|
| 61 | if (this->expectBuffer->available()) {
|
---|
| 62 | uint8_t expected = this->expectBuffer->next();
|
---|
| 63 | if (expected != b) {
|
---|
| 64 | this->_error = true;
|
---|
| 65 | TRACE("!=" << (unsigned int)expected);
|
---|
| 66 | }
|
---|
| 67 | } else {
|
---|
| 68 | this->_error = true;
|
---|
| 69 | }
|
---|
| 70 | }
|
---|
| 71 | TRACE("\n"<< std::dec);
|
---|
| 72 | return 1;
|
---|
| 73 | }
|
---|
| 74 | size_t ShimClient::write(const uint8_t *buf, size_t size) {
|
---|
| 75 | this->_received += size;
|
---|
| 76 | TRACE( "[" << std::dec << (unsigned int)(size) << "] ");
|
---|
| 77 | uint16_t i=0;
|
---|
| 78 | for (;i<size;i++) {
|
---|
| 79 | if (i>0) {
|
---|
| 80 | TRACE(":");
|
---|
| 81 | }
|
---|
| 82 | TRACE(std::hex << (unsigned int)(buf[i]));
|
---|
| 83 |
|
---|
| 84 | if (!this->expectAnything) {
|
---|
| 85 | if (this->expectBuffer->available()) {
|
---|
| 86 | uint8_t expected = this->expectBuffer->next();
|
---|
| 87 | if (expected != buf[i]) {
|
---|
| 88 | this->_error = true;
|
---|
| 89 | TRACE("!=" << (unsigned int)expected);
|
---|
| 90 | }
|
---|
| 91 | } else {
|
---|
| 92 | this->_error = true;
|
---|
| 93 | }
|
---|
| 94 | }
|
---|
| 95 | }
|
---|
| 96 | TRACE("\n"<<std::dec);
|
---|
| 97 | return size;
|
---|
| 98 | }
|
---|
| 99 | int ShimClient::available() {
|
---|
| 100 | return this->responseBuffer->available();
|
---|
| 101 | }
|
---|
| 102 | int ShimClient::read() { return this->responseBuffer->next(); }
|
---|
| 103 | int ShimClient::read(uint8_t *buf, size_t size) {
|
---|
| 104 | uint16_t i = 0;
|
---|
| 105 | for (;i<size;i++) {
|
---|
| 106 | buf[i] = this->read();
|
---|
| 107 | }
|
---|
| 108 | return size;
|
---|
| 109 | }
|
---|
| 110 | int ShimClient::peek() { return 0; }
|
---|
| 111 | void ShimClient::flush() {}
|
---|
| 112 | void ShimClient::stop() {
|
---|
| 113 | this->setConnected(false);
|
---|
| 114 | }
|
---|
| 115 | uint8_t ShimClient::connected() { return this->_connected; }
|
---|
| 116 | ShimClient::operator bool() { return true; }
|
---|
| 117 |
|
---|
| 118 |
|
---|
| 119 | ShimClient* ShimClient::respond(uint8_t *buf, size_t size) {
|
---|
| 120 | this->responseBuffer->add(buf,size);
|
---|
| 121 | return this;
|
---|
| 122 | }
|
---|
| 123 |
|
---|
| 124 | ShimClient* ShimClient::expect(uint8_t *buf, size_t size) {
|
---|
| 125 | this->expectAnything = false;
|
---|
| 126 | this->expectBuffer->add(buf,size);
|
---|
| 127 | return this;
|
---|
| 128 | }
|
---|
| 129 |
|
---|
| 130 | void ShimClient::setConnected(bool b) {
|
---|
| 131 | this->_connected = b;
|
---|
| 132 | }
|
---|
| 133 | void ShimClient::setAllowConnect(bool b) {
|
---|
| 134 | this->_allowConnect = b;
|
---|
| 135 | }
|
---|
| 136 |
|
---|
| 137 | bool ShimClient::error() {
|
---|
| 138 | return this->_error;
|
---|
| 139 | }
|
---|
| 140 |
|
---|
| 141 | uint16_t ShimClient::received() {
|
---|
| 142 | return this->_received;
|
---|
| 143 | }
|
---|
| 144 |
|
---|
| 145 | void ShimClient::expectConnect(IPAddress ip, uint16_t port) {
|
---|
| 146 | this->_expectedIP = ip;
|
---|
| 147 | this->_expectedPort = port;
|
---|
| 148 | }
|
---|
| 149 |
|
---|
| 150 | void ShimClient::expectConnect(const char *host, uint16_t port) {
|
---|
| 151 | this->_expectedHost = host;
|
---|
| 152 | this->_expectedPort = port;
|
---|
| 153 | }
|
---|