ktpd_session.c 8.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413
  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. if (exec) {
  70. kexec_contexts_node_t *iter = kexec_contexts_iter(exec);
  71. kcontext_t *context = NULL;
  72. while ((context = kexec_contexts_each(&iter))) {
  73. kpargv_debug(kcontext_pargv(context));
  74. }
  75. } else {
  76. faux_error_show(error);
  77. }
  78. // kpargv_debug(pargv);
  79. // if (kpargv_status(pargv) != KPARSE_OK) {
  80. // char *error = NULL;
  81. // error = faux_str_sprintf("Can't parse line: %s",
  82. // kpargv_status_str(pargv));
  83. // kpargv_free(pargv);
  84. // ktpd_session_send_error(session, cmd, error);
  85. // return BOOL_FALSE;
  86. // }
  87. //
  88. // kpargv_free(pargv);
  89. kexec_free(exec);
  90. faux_error_free(error);
  91. // Send ACK message
  92. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  93. faux_msg_send_async(ack, session->async);
  94. faux_msg_free(ack);
  95. return BOOL_TRUE;
  96. }
  97. static bool_t ktpd_session_process_completion(ktpd_session_t *session, faux_msg_t *msg)
  98. {
  99. char *line = NULL;
  100. faux_msg_t *ack = NULL;
  101. kpargv_t *pargv = NULL;
  102. ktp_cmd_e cmd = KTP_COMPLETION_ACK;
  103. assert(session);
  104. assert(msg);
  105. // Get line from message
  106. if (!(line = faux_msg_get_str_param_by_type(msg, KTP_PARAM_LINE))) {
  107. ktpd_session_send_error(session, cmd, NULL);
  108. return BOOL_FALSE;
  109. }
  110. // Parsing
  111. pargv = ksession_parse_for_completion(session->ksession, line);
  112. faux_str_free(line);
  113. if (!pargv) {
  114. ktpd_session_send_error(session, cmd, NULL);
  115. return BOOL_FALSE;
  116. }
  117. kpargv_debug(pargv);
  118. kpargv_free(pargv);
  119. // Send ACK message
  120. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  121. faux_msg_send_async(ack, session->async);
  122. faux_msg_free(ack);
  123. return BOOL_TRUE;
  124. }
  125. static bool_t ktpd_session_process_help(ktpd_session_t *session, faux_msg_t *msg)
  126. {
  127. char *line = NULL;
  128. faux_msg_t *ack = NULL;
  129. // kpargv_t *pargv = NULL;
  130. ktp_cmd_e cmd = KTP_HELP_ACK;
  131. assert(session);
  132. assert(msg);
  133. // Get line from message
  134. if (!(line = faux_msg_get_str_param_by_type(msg, KTP_PARAM_LINE))) {
  135. ktpd_session_send_error(session, cmd, NULL);
  136. return BOOL_FALSE;
  137. }
  138. /* // Parsing
  139. pargv = ksession_parse_line(session->ksession, line, KPURPOSE_HELP);
  140. faux_str_free(line);
  141. kpargv_free(pargv);
  142. */
  143. // Send ACK message
  144. ack = ktp_msg_preform(cmd, KTP_STATUS_NONE);
  145. faux_msg_send_async(ack, session->async);
  146. faux_msg_free(ack);
  147. return BOOL_TRUE;
  148. }
  149. static bool_t ktpd_session_dispatch(ktpd_session_t *session, faux_msg_t *msg)
  150. {
  151. uint16_t cmd = 0;
  152. assert(session);
  153. if (!session)
  154. return BOOL_FALSE;
  155. assert(msg);
  156. if (!msg)
  157. return BOOL_FALSE;
  158. cmd = faux_msg_get_cmd(msg);
  159. switch (cmd) {
  160. case KTP_CMD:
  161. ktpd_session_process_cmd(session, msg);
  162. break;
  163. case KTP_COMPLETION:
  164. ktpd_session_process_completion(session, msg);
  165. break;
  166. case KTP_HELP:
  167. ktpd_session_process_help(session, msg);
  168. break;
  169. default:
  170. syslog(LOG_WARNING, "Unsupported command: 0x%04u\n", cmd);
  171. break;
  172. }
  173. return BOOL_TRUE;
  174. }
  175. /** @brief Low-level function to receive KTP message.
  176. *
  177. * Firstly function gets the header of message. Then it checks and parses
  178. * header and find out the length of whole message. Then it receives the rest
  179. * of message.
  180. */
  181. static bool_t ktpd_session_read_cb(faux_async_t *async,
  182. void *data, size_t len, void *user_data)
  183. {
  184. ktpd_session_t *session = (ktpd_session_t *)user_data;
  185. faux_msg_t *completed_msg = NULL;
  186. assert(async);
  187. assert(data);
  188. assert(session);
  189. // Receive header
  190. if (!session->hdr) {
  191. size_t whole_len = 0;
  192. size_t msg_wo_hdr = 0;
  193. session->hdr = (faux_hdr_t *)data;
  194. // Check for broken header
  195. if (!check_ktp_header(session->hdr)) {
  196. faux_free(session->hdr);
  197. session->hdr = NULL;
  198. return BOOL_FALSE;
  199. }
  200. whole_len = faux_hdr_len(session->hdr);
  201. // msg_wo_hdr >= 0 because check_ktp_header() validates whole_len
  202. msg_wo_hdr = whole_len - sizeof(faux_hdr_t);
  203. // Plan to receive message body
  204. if (msg_wo_hdr > 0) {
  205. faux_async_set_read_limits(async,
  206. msg_wo_hdr, msg_wo_hdr);
  207. return BOOL_TRUE;
  208. }
  209. // Here message is completed (msg body has zero length)
  210. completed_msg = faux_msg_deserialize_parts(session->hdr, NULL, 0);
  211. // Receive message body
  212. } else {
  213. completed_msg = faux_msg_deserialize_parts(session->hdr, data, len);
  214. faux_free(data);
  215. }
  216. // Plan to receive msg header
  217. faux_async_set_read_limits(session->async,
  218. sizeof(faux_hdr_t), sizeof(faux_hdr_t));
  219. faux_free(session->hdr);
  220. session->hdr = NULL; // Ready to recv new header
  221. // Here message is completed
  222. ktpd_session_dispatch(session, completed_msg);
  223. faux_msg_free(completed_msg);
  224. return BOOL_TRUE;
  225. }
  226. static bool_t ktpd_session_stall_cb(faux_async_t *async,
  227. size_t len, void *user_data)
  228. {
  229. ktpd_session_t *session = (ktpd_session_t *)user_data;
  230. assert(async);
  231. assert(session);
  232. if (!session->stall_cb)
  233. return BOOL_TRUE;
  234. session->stall_cb(session, session->stall_udata);
  235. async = async; // Happy compiler
  236. len = len; // Happy compiler
  237. return BOOL_TRUE;
  238. }
  239. ktpd_session_t *ktpd_session_new(int sock, const kscheme_t *scheme,
  240. const char *start_entry)
  241. {
  242. ktpd_session_t *session = NULL;
  243. if (sock < 0)
  244. return NULL;
  245. session = faux_zmalloc(sizeof(*session));
  246. assert(session);
  247. if (!session)
  248. return NULL;
  249. // Init
  250. session->state = KTPD_SESSION_STATE_NOT_AUTHORIZED;
  251. session->ksession = ksession_new(scheme, start_entry);
  252. assert(session->ksession);
  253. session->async = faux_async_new(sock);
  254. assert(session->async);
  255. // Receive message header first
  256. faux_async_set_read_limits(session->async,
  257. sizeof(faux_hdr_t), sizeof(faux_hdr_t));
  258. faux_async_set_read_cb(session->async, ktpd_session_read_cb, session);
  259. session->hdr = NULL;
  260. return session;
  261. }
  262. void ktpd_session_free(ktpd_session_t *session)
  263. {
  264. if (!session)
  265. return;
  266. ksession_free(session->ksession);
  267. faux_free(session->hdr);
  268. close(ktpd_session_fd(session));
  269. faux_async_free(session->async);
  270. faux_free(session);
  271. }
  272. bool_t ktpd_session_connected(ktpd_session_t *session)
  273. {
  274. assert(session);
  275. if (!session)
  276. return BOOL_FALSE;
  277. if (KTPD_SESSION_STATE_DISCONNECTED == session->state)
  278. return BOOL_FALSE;
  279. return BOOL_TRUE;
  280. }
  281. int ktpd_session_fd(const ktpd_session_t *session)
  282. {
  283. assert(session);
  284. if (!session)
  285. return BOOL_FALSE;
  286. return faux_async_fd(session->async);
  287. }
  288. bool_t ktpd_session_async_in(ktpd_session_t *session)
  289. {
  290. assert(session);
  291. if (!session)
  292. return BOOL_FALSE;
  293. if (!ktpd_session_connected(session))
  294. return BOOL_FALSE;
  295. if (faux_async_in(session->async) < 0)
  296. return BOOL_FALSE;
  297. return BOOL_TRUE;
  298. }
  299. bool_t ktpd_session_async_out(ktpd_session_t *session)
  300. {
  301. assert(session);
  302. if (!session)
  303. return BOOL_FALSE;
  304. if (!ktpd_session_connected(session))
  305. return BOOL_FALSE;
  306. if (faux_async_out(session->async) < 0)
  307. return BOOL_FALSE;
  308. return BOOL_TRUE;
  309. }
  310. void ktpd_session_set_stall_cb(ktpd_session_t *session,
  311. ktpd_session_stall_cb_fn stall_cb, void *user_data)
  312. {
  313. assert(session);
  314. if (!session)
  315. return;
  316. session->stall_cb = stall_cb;
  317. session->stall_udata = user_data;
  318. faux_async_set_stall_cb(session->async, ktpd_session_stall_cb, session);
  319. }
  320. #if 0
  321. static void ktpd_session_bad_socket(ktpd_session_t *session)
  322. {
  323. assert(session);
  324. if (!session)
  325. return;
  326. session->state = KTPD_SESSION_STATE_DISCONNECTED;
  327. }
  328. #endif