ktpd_session.c 8.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410
  1. #include <stdlib.h>
  2. #include <stdio.h>
  3. #include <string.h>
  4. #include <assert.h>
  5. #include <unistd.h>
  6. #include <errno.h>
  7. #include <sys/types.h>
  8. #include <sys/stat.h>
  9. #include <fcntl.h>
  10. #include <sys/socket.h>
  11. #include <sys/un.h>
  12. #include <syslog.h>
  13. #include <faux/str.h>
  14. #include <faux/async.h>
  15. #include <faux/msg.h>
  16. #include <klish/ksession.h>
  17. #include <klish/ktp.h>
  18. #include <klish/ktp_session.h>
  19. #include "private.h"
  20. static bool_t check_ktp_header(faux_hdr_t *hdr)
  21. {
  22. assert(hdr);
  23. if (!hdr)
  24. return BOOL_FALSE;
  25. if (faux_hdr_magic(hdr) != KTP_MAGIC)
  26. return BOOL_FALSE;
  27. if (faux_hdr_major(hdr) != KTP_MAJOR)
  28. return BOOL_FALSE;
  29. if (faux_hdr_minor(hdr) != KTP_MINOR)
  30. return BOOL_FALSE;
  31. if (faux_hdr_len(hdr) < (int)sizeof(*hdr))
  32. return BOOL_FALSE;
  33. return BOOL_TRUE;
  34. }
  35. static bool_t ktpd_session_send_error(ktpd_session_t *session,
  36. ktp_cmd_e cmd, const char *error)
  37. {
  38. faux_msg_t *msg = NULL;
  39. assert(session);
  40. if (!session)
  41. return BOOL_FALSE;
  42. msg = ktp_msg_preform(cmd, KTP_STATUS_ERROR);
  43. if (error)
  44. faux_msg_add_param(msg, KTP_PARAM_ERROR, error, strlen(error));
  45. faux_msg_send_async(msg, session->async);
  46. faux_msg_free(msg);
  47. return BOOL_TRUE;
  48. }
  49. static bool_t ktpd_session_process_cmd(ktpd_session_t *session, faux_msg_t *msg)
  50. {
  51. char *line = NULL;
  52. faux_msg_t *ack = NULL;
  53. // kpargv_t *pargv = NULL;
  54. ktp_cmd_e cmd = KTP_CMD_ACK;
  55. kexec_t *exec = NULL;
  56. faux_error_t *error = NULL;
  57. assert(session);
  58. assert(msg);
  59. // Get line from message
  60. if (!(line = faux_msg_get_str_param_by_type(msg, KTP_PARAM_LINE))) {
  61. ktpd_session_send_error(session, cmd,
  62. "The line is not specified");
  63. return BOOL_FALSE;
  64. }
  65. // Parsing
  66. error = faux_error_new();
  67. exec = ksession_parse_for_exec(session->ksession, line, error);
  68. faux_str_free(line);
  69. kexec_contexts_node_t *iter = kexec_contexts_iter(exec);
  70. kcontext_t *context = NULL;
  71. while ((context = kexec_contexts_each(&iter))) {
  72. kpargv_debug(kcontext_pargv(context));
  73. }
  74. // kpargv_debug(pargv);
  75. // if (kpargv_status(pargv) != KPARSE_OK) {
  76. // char *error = NULL;
  77. // error = faux_str_sprintf("Can't parse line: %s",
  78. // kpargv_status_str(pargv));
  79. // kpargv_free(pargv);
  80. // ktpd_session_send_error(session, cmd, error);
  81. // return BOOL_FALSE;
  82. // }
  83. //
  84. // kpargv_free(pargv);
  85. faux_error_show(error);
  86. kexec_free(exec);
  87. faux_error_free(error);
  88. // Send ACK message
  89. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  90. faux_msg_send_async(ack, session->async);
  91. faux_msg_free(ack);
  92. return BOOL_TRUE;
  93. }
  94. static bool_t ktpd_session_process_completion(ktpd_session_t *session, faux_msg_t *msg)
  95. {
  96. char *line = NULL;
  97. faux_msg_t *ack = NULL;
  98. kpargv_t *pargv = NULL;
  99. ktp_cmd_e cmd = KTP_COMPLETION_ACK;
  100. assert(session);
  101. assert(msg);
  102. // Get line from message
  103. if (!(line = faux_msg_get_str_param_by_type(msg, KTP_PARAM_LINE))) {
  104. ktpd_session_send_error(session, cmd, NULL);
  105. return BOOL_FALSE;
  106. }
  107. // Parsing
  108. pargv = ksession_parse_for_completion(session->ksession, line);
  109. faux_str_free(line);
  110. if (!pargv) {
  111. ktpd_session_send_error(session, cmd, NULL);
  112. return BOOL_FALSE;
  113. }
  114. kpargv_debug(pargv);
  115. kpargv_free(pargv);
  116. // Send ACK message
  117. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  118. faux_msg_send_async(ack, session->async);
  119. faux_msg_free(ack);
  120. return BOOL_TRUE;
  121. }
  122. static bool_t ktpd_session_process_help(ktpd_session_t *session, faux_msg_t *msg)
  123. {
  124. char *line = NULL;
  125. faux_msg_t *ack = NULL;
  126. // kpargv_t *pargv = NULL;
  127. ktp_cmd_e cmd = KTP_HELP_ACK;
  128. assert(session);
  129. assert(msg);
  130. // Get line from message
  131. if (!(line = faux_msg_get_str_param_by_type(msg, KTP_PARAM_LINE))) {
  132. ktpd_session_send_error(session, cmd, NULL);
  133. return BOOL_FALSE;
  134. }
  135. /* // Parsing
  136. pargv = ksession_parse_line(session->ksession, line, KPURPOSE_HELP);
  137. faux_str_free(line);
  138. kpargv_free(pargv);
  139. */
  140. // Send ACK message
  141. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  142. faux_msg_send_async(ack, session->async);
  143. faux_msg_free(ack);
  144. return BOOL_TRUE;
  145. }
  146. static bool_t ktpd_session_dispatch(ktpd_session_t *session, faux_msg_t *msg)
  147. {
  148. uint16_t cmd = 0;
  149. assert(session);
  150. if (!session)
  151. return BOOL_FALSE;
  152. assert(msg);
  153. if (!msg)
  154. return BOOL_FALSE;
  155. cmd = faux_msg_get_cmd(msg);
  156. switch (cmd) {
  157. case KTP_CMD:
  158. ktpd_session_process_cmd(session, msg);
  159. break;
  160. case KTP_COMPLETION:
  161. ktpd_session_process_completion(session, msg);
  162. break;
  163. case KTP_HELP:
  164. ktpd_session_process_help(session, msg);
  165. break;
  166. default:
  167. syslog(LOG_WARNING, "Unsupported command: 0x%04u\n", cmd);
  168. break;
  169. }
  170. return BOOL_TRUE;
  171. }
  172. /** @brief Low-level function to receive KTP message.
  173. *
  174. * Firstly function gets the header of message. Then it checks and parses
  175. * header and find out the length of whole message. Then it receives the rest
  176. * of message.
  177. */
  178. static bool_t ktpd_session_read_cb(faux_async_t *async,
  179. void *data, size_t len, void *user_data)
  180. {
  181. ktpd_session_t *session = (ktpd_session_t *)user_data;
  182. faux_msg_t *completed_msg = NULL;
  183. assert(async);
  184. assert(data);
  185. assert(session);
  186. // Receive header
  187. if (!session->hdr) {
  188. size_t whole_len = 0;
  189. size_t msg_wo_hdr = 0;
  190. session->hdr = (faux_hdr_t *)data;
  191. // Check for broken header
  192. if (!check_ktp_header(session->hdr)) {
  193. faux_free(session->hdr);
  194. session->hdr = NULL;
  195. return BOOL_FALSE;
  196. }
  197. whole_len = faux_hdr_len(session->hdr);
  198. // msg_wo_hdr >= 0 because check_ktp_header() validates whole_len
  199. msg_wo_hdr = whole_len - sizeof(faux_hdr_t);
  200. // Plan to receive message body
  201. if (msg_wo_hdr > 0) {
  202. faux_async_set_read_limits(async,
  203. msg_wo_hdr, msg_wo_hdr);
  204. return BOOL_TRUE;
  205. }
  206. // Here message is completed (msg body has zero length)
  207. completed_msg = faux_msg_deserialize_parts(session->hdr, NULL, 0);
  208. // Receive message body
  209. } else {
  210. completed_msg = faux_msg_deserialize_parts(session->hdr, data, len);
  211. faux_free(data);
  212. }
  213. // Plan to receive msg header
  214. faux_async_set_read_limits(session->async,
  215. sizeof(faux_hdr_t), sizeof(faux_hdr_t));
  216. faux_free(session->hdr);
  217. session->hdr = NULL; // Ready to recv new header
  218. // Here message is completed
  219. ktpd_session_dispatch(session, completed_msg);
  220. faux_msg_free(completed_msg);
  221. return BOOL_TRUE;
  222. }
  223. static bool_t ktpd_session_stall_cb(faux_async_t *async,
  224. size_t len, void *user_data)
  225. {
  226. ktpd_session_t *session = (ktpd_session_t *)user_data;
  227. assert(async);
  228. assert(session);
  229. if (!session->stall_cb)
  230. return BOOL_TRUE;
  231. session->stall_cb(session, session->stall_udata);
  232. async = async; // Happy compiler
  233. len = len; // Happy compiler
  234. return BOOL_TRUE;
  235. }
  236. ktpd_session_t *ktpd_session_new(int sock, const kscheme_t *scheme,
  237. const char *start_entry)
  238. {
  239. ktpd_session_t *session = NULL;
  240. if (sock < 0)
  241. return NULL;
  242. session = faux_zmalloc(sizeof(*session));
  243. assert(session);
  244. if (!session)
  245. return NULL;
  246. // Init
  247. session->state = KTPD_SESSION_STATE_NOT_AUTHORIZED;
  248. session->ksession = ksession_new(scheme, start_entry);
  249. assert(session->ksession);
  250. session->async = faux_async_new(sock);
  251. assert(session->async);
  252. // Receive message header first
  253. faux_async_set_read_limits(session->async,
  254. sizeof(faux_hdr_t), sizeof(faux_hdr_t));
  255. faux_async_set_read_cb(session->async, ktpd_session_read_cb, session);
  256. session->hdr = NULL;
  257. return session;
  258. }
  259. void ktpd_session_free(ktpd_session_t *session)
  260. {
  261. if (!session)
  262. return;
  263. ksession_free(session->ksession);
  264. faux_free(session->hdr);
  265. close(ktpd_session_fd(session));
  266. faux_async_free(session->async);
  267. faux_free(session);
  268. }
  269. bool_t ktpd_session_connected(ktpd_session_t *session)
  270. {
  271. assert(session);
  272. if (!session)
  273. return BOOL_FALSE;
  274. if (KTPD_SESSION_STATE_DISCONNECTED == session->state)
  275. return BOOL_FALSE;
  276. return BOOL_TRUE;
  277. }
  278. int ktpd_session_fd(const ktpd_session_t *session)
  279. {
  280. assert(session);
  281. if (!session)
  282. return BOOL_FALSE;
  283. return faux_async_fd(session->async);
  284. }
  285. bool_t ktpd_session_async_in(ktpd_session_t *session)
  286. {
  287. assert(session);
  288. if (!session)
  289. return BOOL_FALSE;
  290. if (!ktpd_session_connected(session))
  291. return BOOL_FALSE;
  292. if (faux_async_in(session->async) < 0)
  293. return BOOL_FALSE;
  294. return BOOL_TRUE;
  295. }
  296. bool_t ktpd_session_async_out(ktpd_session_t *session)
  297. {
  298. assert(session);
  299. if (!session)
  300. return BOOL_FALSE;
  301. if (!ktpd_session_connected(session))
  302. return BOOL_FALSE;
  303. if (faux_async_out(session->async) < 0)
  304. return BOOL_FALSE;
  305. return BOOL_TRUE;
  306. }
  307. void ktpd_session_set_stall_cb(ktpd_session_t *session,
  308. faux_session_stall_cb_fn stall_cb, void *user_data)
  309. {
  310. assert(session);
  311. if (!session)
  312. return;
  313. session->stall_cb = stall_cb;
  314. session->stall_udata = user_data;
  315. faux_async_set_stall_cb(session->async, ktpd_session_stall_cb, session);
  316. }
  317. #if 0
  318. static void ktpd_session_bad_socket(ktpd_session_t *session)
  319. {
  320. assert(session);
  321. if (!session)
  322. return;
  323. session->state = KTPD_SESSION_STATE_DISCONNECTED;
  324. }
  325. #endif