A C++ toolbox repo until the pair uTL/dTL arives
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 

305 lines
12 KiB

  1. /*!
  2. * \file ATmodem.cpp
  3. *
  4. * \copyright Copyright (C) 2020 Christos Choutouridis <christos@choutouridis.net>
  5. *
  6. * <dl class=\"section copyright\"><dt>License</dt><dd>
  7. * The MIT License (MIT)
  8. *
  9. * Permission is hereby granted, free of charge, to any person obtaining a copy
  10. * of this software and associated documentation files (the "Software"), to deal
  11. * in the Software without restriction, including without limitation the rights
  12. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  13. * copies of the Software, and to permit persons to whom the Software is
  14. * furnished to do so, subject to the following conditions:
  15. *
  16. * The above copyright notice and this permission notice shall be included in all
  17. * copies or substantial portions of the Software.
  18. *
  19. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  22. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  23. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  24. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  25. * SOFTWARE.
  26. * </dd></dl>
  27. *
  28. */
  29. #include <drv/ATmodem.h>
  30. #include <gtest/gtest.h>
  31. #include <cont/equeue.h>
  32. #include <cstring>
  33. #include <utility>
  34. #include <type_traits>
  35. #ifndef WIN_TRHEADS
  36. #include <mutex>
  37. #include <thread>
  38. #else
  39. #include <mingw.thread.h>
  40. #include <mingw.mutex.h>
  41. #endif
  42. namespace test_ATmodem {
  43. using namespace tbx;
  44. // test settings
  45. constexpr size_t Size = 128;
  46. using data_type = char;
  47. // BG95 implementer mock
  48. template<size_t N>
  49. class BG95 : public ATmodem<BG95<N>, N> {
  50. using base_type = ATmodem<BG95<N>, N>;
  51. using Queue = equeue<typename base_type::value_type, N, true>;
  52. public:
  53. enum class event {
  54. MQTT_DISCONNECT, MQTT_RXDATA
  55. };
  56. // simulated modem operation
  57. private:
  58. struct cmd_pair {
  59. const char *cmd;
  60. const char *resp;
  61. };
  62. struct event_pair {
  63. event e;
  64. const char* resp;
  65. };
  66. std::array<cmd_pair, 19> cmd_map = {{
  67. {"ERROR", "\r\nERROR\r\n"},
  68. {"ATE0\r\n", "\r\nATE0\r\nOK\r\n"},
  69. {"AT\r\n", "\r\nOK\r\n"},
  70. {"AT+QCFG=\"nwscanseq\"\r\n", "\r\n+QCFG: \"nwscanseq\",020301\r\n"},
  71. {"AT+QCFG=\"nwscanseq\",010302\r\n", "\r\nOK\r\n"},
  72. {"AT+CREG?\r\n", "\r\n+CREG: 0,5\r\n\r\nOK\r\n"},
  73. {"AT+CSQ\r\n", "\r\n+CSQ: 19,99\r\n\r\nOK\r\n"},
  74. {"AT+QNWINFO\r\n", "\r\n+QNWINFO: \"EDGE\",\"20201\",\"GSM 1800\",865\r\n\r\nOK\r\n"},
  75. // Files
  76. {"AT+QFLST\r\n", "\r\n+QFLST: \"cacert.pem\",1220\r\n+QFLST: \"security/\",2\r\nOK\r\n"},
  77. // MQTT config
  78. {"AT+QSSLCFG=\"ignorelocaltime\",2,1\r\n", "\r\nOK\r\n"},
  79. {"AT+QSSLCFG=\"seclevel\",2,1\r\n", "\r\nOK\r\n"},
  80. {"AT+QSSLCFG=\"sslversion\",2,4\r\n", "\r\nOK\r\n"},
  81. {"AT+QSSLCFG=\"ciphersuite\",2\r\n", "\r\n+QSSLCFG: \"ciphersuite\",2,0XFFFF\r\n\r\nOK\r\n"},
  82. {"AT+QMTCFG=\"ssl\",0,1,2\r\n", "\r\nOK\r\n"},
  83. {"AT+QMTCFG=\"keepalive\",0,3600\r\n", "\r\nOK\r\n"},
  84. // MQTT
  85. {"AT+QMTOPEN=0,\"server.com\",8883\r\n", "\r\nOK\r\n\r\n+QMTOPEN: 0,0\r\n"},
  86. {"AT+QMTCONN=0,\"myID\",\"user\",\"pass\"\r\n", "\r\nOK\r\n\r\n+QMTCONN: 0,0,0\r\n"},
  87. {"AT+QMTSUB=0,1,\"/path/topic1\",2\r\n", "\r\nOK\r\n\r\n+QMTSUB: 0,1,0,2\r\n"},
  88. {"AT+QMTPUB=0,0,0,0,\"/path/topic2\",9\r\n", "\r\n> \r\nOK\r\n\r\n+QMTPUB: 0,0,0\r\n"},
  89. }};
  90. std::array<event_pair, 2> event_map {{
  91. {event::MQTT_DISCONNECT, "\r\n+QMTSTAT: 0,1\r\n"},
  92. {event::MQTT_RXDATA, "\r\n+QMTRECV: 0,1,\"/path/topic1\",\"BR: hello to all of my subscribers\""}
  93. }};
  94. const char* cmd_responce (const char* cmd) {
  95. for (auto& it : cmd_map) {
  96. if (!strcmp(it.cmd, cmd))
  97. return it.resp;
  98. }
  99. return cmd_map[0].resp;
  100. }
  101. const char* event_responce (const event e) {
  102. for (auto& it : event_map) {
  103. if (e == it.e)
  104. return it.resp;
  105. }
  106. return nullptr; // non reachable
  107. }
  108. // data
  109. Queue rx_q{};
  110. std::atomic<size_t> lines{};
  111. public:
  112. // ATmodem driver requirements
  113. BG95() noexcept :
  114. rx_q(Queue::data_match::MATCH_PUSH, base_type::delimiter, [&](){
  115. lines.fetch_add(1, std::memory_order_acq_rel);
  116. }), lines(0) { }
  117. size_t get(char* data, bool wait =false) {
  118. do {
  119. if (lines.load(std::memory_order_acquire)) {
  120. size_t n =0;
  121. do{
  122. *data << rx_q;
  123. ++n;
  124. } while (*data++ != base_type::delimiter);
  125. lines.fetch_sub(1, std::memory_order_acq_rel);
  126. return n;
  127. }
  128. } while (wait);
  129. return 0;
  130. }
  131. size_t contents(char* data) {
  132. char* nullpos = std::copy(rx_q.begin(), rx_q.end(), data);
  133. *nullpos =0;
  134. return nullpos - data;
  135. }
  136. size_t put (const char* data, size_t n) {
  137. const char* reply = cmd_responce (data);
  138. while (*reply)
  139. rx_q << *reply++;
  140. return n;
  141. }
  142. clock_t clock() { static clock_t t=0; return ++t; }
  143. // extra helper for testing purposes
  144. void async (event e) {
  145. const char* reply =event_responce (e);
  146. while (*reply)
  147. rx_q << *reply++;
  148. }
  149. };
  150. // Behavior flag
  151. bool handler_flag = false;
  152. void handler (const char* data, size_t n) {
  153. (void)*data;
  154. (void)n;
  155. handler_flag = true;
  156. }
  157. void clear_flag () {
  158. handler_flag = false;
  159. }
  160. TEST(TATmodem, traits) {
  161. EXPECT_EQ ( std::is_default_constructible<BG95<Size>>::value, true);
  162. EXPECT_EQ ( std::is_nothrow_default_constructible<BG95<Size>>::value, true);
  163. EXPECT_EQ (!std::is_copy_constructible<BG95<Size>>::value, true);
  164. EXPECT_EQ (!std::is_copy_assignable<BG95<Size>>::value, true);
  165. EXPECT_EQ ((std::is_same_v<BG95<Size>::value_type, data_type>), true);
  166. EXPECT_EQ ((std::is_same_v<BG95<Size>::pointer_type, data_type*>), true);
  167. EXPECT_EQ ((std::is_same_v<BG95<Size>::size_type, size_t>), true);
  168. EXPECT_EQ ((std::is_same_v<BG95<Size>::string_view, std::basic_string_view<data_type>>), true);
  169. BG95<Size> m;
  170. EXPECT_EQ (m.size(), Size);
  171. }
  172. /*
  173. * Test inetd in non blocking mode
  174. */
  175. TEST(TATmodem, inetd_non_blocking) {
  176. BG95<Size> modem;
  177. char buffer[Size];
  178. const BG95<Size>::inetd_handlers<2> async = {{
  179. {"+QMTSTAT:", BG95<Size>::starts_with, handler},
  180. {"+QMTRECV", BG95<Size>::contains, handler},
  181. }};
  182. clear_flag();
  183. modem.inetd(false, &async);
  184. EXPECT_EQ (handler_flag, false);
  185. modem.async(BG95<Size>::event::MQTT_DISCONNECT);
  186. modem.inetd(false, &async); // parse "\r\n"
  187. EXPECT_EQ (handler_flag, false);
  188. modem.inetd(false, &async); // parse "+QMT*\r\n" and dispatch to handler()
  189. EXPECT_EQ (handler_flag, true);
  190. clear_flag(); // nothing to parse
  191. modem.inetd(false, &async);
  192. modem.inetd(false, &async);
  193. modem.inetd(false, &async);
  194. EXPECT_EQ (handler_flag, false);
  195. EXPECT_NE (modem.receive(buffer), 0UL); // "\r\n" in buffer
  196. EXPECT_EQ (strcmp(buffer, "\r\n"), 0);
  197. clear_flag();
  198. modem.inetd(false, &async);
  199. EXPECT_EQ (handler_flag, false);
  200. modem.transmit("AT+CSQ\r\n", 8);
  201. EXPECT_EQ (modem.receive(buffer), 0UL);
  202. modem.inetd(false, &async); // parse "\r\n"
  203. EXPECT_NE (modem.receive(buffer), 0UL);
  204. EXPECT_EQ (strcmp(buffer, "\r\n"), 0);
  205. modem.inetd(false, &async); // parse "+CSQ: 19,99\r\n"
  206. EXPECT_NE (modem.receive(buffer), 0UL);
  207. EXPECT_EQ (strcmp(buffer, "+CSQ: 19,99\r\n"), 0);
  208. modem.inetd(false, &async); // parse "\r\n"
  209. EXPECT_NE (modem.receive(buffer), 0UL);
  210. EXPECT_EQ (strcmp(buffer, "\r\n"), 0);
  211. modem.inetd(false, &async); // parse "OK\r\n"
  212. EXPECT_NE (modem.receive(buffer), 0UL);
  213. EXPECT_EQ (strcmp(buffer, "OK\r\n"), 0);
  214. modem.inetd(false, &async); // nothing to parse
  215. modem.inetd(false, &async);
  216. modem.inetd(false, &async);
  217. EXPECT_EQ (modem.receive(buffer), 0UL);
  218. }
  219. TEST(TATmodem, run) {
  220. BG95<Size> modem;
  221. using Control = BG95<Size>::control_t;
  222. const BG95<Size>::script_t<4> script = {{
  223. {Control::NOP, "", BG95<Size>::nil, BG95<Size>::nil, BG95<Size>::go_to<1>, 1000},
  224. {Control::SEND, "ATE0\r\n", BG95<Size>::nil, BG95<Size>::nil, BG95<Size>::next, 0},
  225. {Control::EXPECT, "OK\r\n", BG95<Size>::ends_with, BG95<Size>::nil, BG95<Size>::exit_ok, 1000},
  226. {Control::OR_EXPECT,"ERROR", BG95<Size>::contains, BG95<Size>::nil, BG95<Size>::exit_error, 0}
  227. }};
  228. std::mutex m;
  229. m.lock();
  230. std::thread th1 ([&](){
  231. do
  232. modem.inetd(false);
  233. while (!m.try_lock());
  234. m.unlock();
  235. });
  236. EXPECT_EQ (modem.run(script), BG95<Size>::exit_ok.value);
  237. m.unlock(); // stop and join inetd
  238. th1.join();
  239. }
  240. TEST(TATmodem, transmit) {
  241. }
  242. TEST(TATmodem, command) {
  243. BG95<Size> modem;
  244. std::mutex m;
  245. m.lock();
  246. std::thread th1 ([&](){
  247. do
  248. modem.inetd(false);
  249. while (!m.try_lock());
  250. m.unlock();
  251. });
  252. EXPECT_EQ (modem.command("AT\r\n", "Something else", 1000), false);
  253. EXPECT_EQ (modem.command("AT\r\n", "\r\nOK\r\n", 1000), true);
  254. EXPECT_EQ (modem.command("AT\r\n", "%OK\r\n", 1000), true);
  255. EXPECT_EQ (modem.command("AT+CREG?\r\n", "%OK\r\n", 1000), false);
  256. EXPECT_EQ (modem.command("AT+CREG?\r\n", "%%%OK\r\n", 1000), true);
  257. int status1, status2;
  258. EXPECT_EQ (modem.command("AT+CREG?\r\n", "\r\n+CREG: 0,%\r\n\r\nOK\r\n", 1000, &status1), true);
  259. EXPECT_EQ (status1, 5);
  260. EXPECT_EQ (modem.command("AT+CREG?\r\n", "\r\n+CREG: %,%\r\n\r\nOK\r\n", 1000, &status1, &status2), true);
  261. EXPECT_EQ (status1, 0);
  262. EXPECT_EQ (status2, 5);
  263. char substr1[32], substr2[32];
  264. EXPECT_EQ (modem.command("AT+CREG?\r\n", "\r\n%\r\n\r\n%\r\n", 1000, substr1, substr2), true);
  265. EXPECT_EQ (strcmp("+CREG: 0,5", substr1), 0);
  266. EXPECT_EQ (strcmp("OK", substr2), 0);
  267. m.unlock(); // stop and join inetd
  268. th1.join();
  269. }
  270. }