portfwd.c 38 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213
  1. /*
  2. * SSH port forwarding.
  3. */
  4. #include <assert.h>
  5. #include <stdio.h>
  6. #include <stdlib.h>
  7. #include "putty.h"
  8. #include "ssh.h"
  9. #include "channel.h"
  10. #include "proxy/socks.h"
  11. /*
  12. * Enumeration of values that live in the 'socks_state' field of
  13. * struct PortForwarding.
  14. */
  15. typedef enum {
  16. SOCKS_NONE, /* direct connection (no SOCKS, or SOCKS already done) */
  17. SOCKS_INITIAL, /* don't know if we're SOCKS 4 or 5 yet */
  18. SOCKS_4, /* expect a SOCKS 4 (or 4A) connection message */
  19. SOCKS_5_INITIAL, /* expect a SOCKS 5 preliminary message */
  20. SOCKS_5_CONNECT /* expect a SOCKS 5 connection message */
  21. } SocksState;
  22. typedef struct PortForwarding {
  23. SshChannel *c; /* channel structure held by SSH connection layer */
  24. ConnectionLayer *cl; /* the connection layer itself */
  25. /* Note that ssh need not be filled in if c is non-NULL */
  26. Socket *s;
  27. bool input_wanted;
  28. bool ready;
  29. SocksState socks_state;
  30. /*
  31. * `hostname' and `port' are the real hostname and port, once
  32. * we know what we're connecting to.
  33. */
  34. char *hostname;
  35. int port;
  36. /*
  37. * `socksbuf' is the buffer we use to accumulate the initial SOCKS
  38. * segment of the incoming data, plus anything after that that we
  39. * receive before we're ready to send data to the SSH server.
  40. */
  41. strbuf *socksbuf;
  42. size_t socksbuf_consumed;
  43. Plug plug;
  44. Channel chan;
  45. } PortForwarding;
  46. struct PortListener {
  47. ConnectionLayer *cl;
  48. Socket *s;
  49. bool is_dynamic;
  50. /*
  51. * `hostname' and `port' are the real hostname and port, for
  52. * ordinary forwardings.
  53. */
  54. char *hostname;
  55. int port;
  56. Plug plug;
  57. };
  58. static struct PortForwarding *new_portfwd_state(void)
  59. {
  60. struct PortForwarding *pf = snew(struct PortForwarding);
  61. pf->hostname = NULL;
  62. pf->socksbuf = NULL;
  63. return pf;
  64. }
  65. static void free_portfwd_state(struct PortForwarding *pf)
  66. {
  67. if (!pf)
  68. return;
  69. sfree(pf->hostname);
  70. if (pf->socksbuf)
  71. strbuf_free(pf->socksbuf);
  72. sfree(pf);
  73. }
  74. static struct PortListener *new_portlistener_state(void)
  75. {
  76. struct PortListener *pl = snew(struct PortListener);
  77. pl->hostname = NULL;
  78. return pl;
  79. }
  80. static void free_portlistener_state(struct PortListener *pl)
  81. {
  82. if (!pl)
  83. return;
  84. sfree(pl->hostname);
  85. sfree(pl);
  86. }
  87. static void pfd_close(struct PortForwarding *pf);
  88. static void pfd_closing(Plug *plug, PlugCloseType type, const char *error_msg)
  89. {
  90. struct PortForwarding *pf =
  91. container_of(plug, struct PortForwarding, plug);
  92. if (type != PLUGCLOSE_NORMAL) {
  93. /*
  94. * Socket error. Slam the connection instantly shut.
  95. */
  96. if (pf->c) {
  97. sshfwd_initiate_close(pf->c, error_msg);
  98. } else {
  99. /*
  100. * We might not have an SSH channel, if a socket error
  101. * occurred during SOCKS negotiation. If not, we must
  102. * clean ourself up without sshfwd_initiate_close's call
  103. * back to pfd_close.
  104. */
  105. pfd_close(pf);
  106. }
  107. } else {
  108. /*
  109. * Ordinary EOF received on socket. Send an EOF on the SSH
  110. * channel.
  111. */
  112. if (pf->c)
  113. sshfwd_write_eof(pf->c);
  114. }
  115. }
  116. static void pfl_terminate(struct PortListener *pl);
  117. static void pfl_closing(Plug *plug, PlugCloseType type, const char *error_msg)
  118. {
  119. struct PortListener *pl = (struct PortListener *) plug;
  120. pfl_terminate(pl);
  121. }
  122. static SshChannel *wrap_lportfwd_open(
  123. ConnectionLayer *cl, const char *hostname, int port,
  124. Socket *s, Channel *chan)
  125. {
  126. SocketEndpointInfo *pi;
  127. char *description;
  128. SshChannel *toret;
  129. pi = sk_peer_info(s);
  130. if (pi && pi->log_text) {
  131. description = dupprintf("forwarding from %s", pi->log_text);
  132. } else {
  133. description = dupstr("forwarding");
  134. }
  135. toret = ssh_lportfwd_open(cl, hostname, port, description, pi, chan);
  136. sk_free_endpoint_info(pi);
  137. sfree(description);
  138. return toret;
  139. }
  140. static char *ipv4_to_string(unsigned ipv4)
  141. {
  142. return dupprintf("%u.%u.%u.%u",
  143. (ipv4 >> 24) & 0xFF, (ipv4 >> 16) & 0xFF,
  144. (ipv4 >> 8) & 0xFF, (ipv4 ) & 0xFF);
  145. }
  146. static char *ipv6_to_string(ptrlen ipv6)
  147. {
  148. const unsigned char *addr = ipv6.ptr;
  149. assert(ipv6.len == 16);
  150. return dupprintf("%04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x",
  151. (unsigned)GET_16BIT_MSB_FIRST(addr + 0),
  152. (unsigned)GET_16BIT_MSB_FIRST(addr + 2),
  153. (unsigned)GET_16BIT_MSB_FIRST(addr + 4),
  154. (unsigned)GET_16BIT_MSB_FIRST(addr + 6),
  155. (unsigned)GET_16BIT_MSB_FIRST(addr + 8),
  156. (unsigned)GET_16BIT_MSB_FIRST(addr + 10),
  157. (unsigned)GET_16BIT_MSB_FIRST(addr + 12),
  158. (unsigned)GET_16BIT_MSB_FIRST(addr + 14));
  159. }
  160. static void pfd_receive(Plug *plug, int urgent, const char *data, size_t len)
  161. {
  162. struct PortForwarding *pf =
  163. container_of(plug, struct PortForwarding, plug);
  164. if (len == 0)
  165. return;
  166. if (pf->socks_state != SOCKS_NONE) {
  167. BinarySource src[1];
  168. /*
  169. * Store all the data we've got in socksbuf.
  170. */
  171. put_data(pf->socksbuf, data, len);
  172. /*
  173. * Check the start of socksbuf to see if it's a valid and
  174. * complete message in the SOCKS exchange.
  175. */
  176. if (pf->socks_state == SOCKS_INITIAL) {
  177. /* Preliminary: check the first byte of the data (which we
  178. * _must_ have by now) to find out which SOCKS major
  179. * version we're speaking. */
  180. switch (pf->socksbuf->u[0]) {
  181. case SOCKS4_REQUEST_VERSION:
  182. pf->socks_state = SOCKS_4;
  183. break;
  184. case SOCKS5_REQUEST_VERSION:
  185. pf->socks_state = SOCKS_5_INITIAL;
  186. break;
  187. default:
  188. pfd_close(pf); /* unrecognised version */
  189. return;
  190. }
  191. }
  192. BinarySource_BARE_INIT(src, pf->socksbuf->u, pf->socksbuf->len);
  193. get_data(src, pf->socksbuf_consumed);
  194. while (pf->socks_state != SOCKS_NONE) {
  195. unsigned socks_version, message_type, reserved_byte;
  196. unsigned reply_code, port, ipv4, method;
  197. ptrlen methods;
  198. const char *socks4_hostname;
  199. strbuf *output;
  200. switch (pf->socks_state) {
  201. case SOCKS_INITIAL:
  202. case SOCKS_NONE:
  203. unreachable("These case values cannot appear");
  204. case SOCKS_4:
  205. /* SOCKS 4/4A connect message */
  206. socks_version = get_byte(src);
  207. message_type = get_byte(src);
  208. if (get_err(src) == BSE_OUT_OF_DATA)
  209. return;
  210. if (socks_version == SOCKS4_REQUEST_VERSION &&
  211. message_type == SOCKS_CMD_CONNECT) {
  212. /* CONNECT message */
  213. bool name_based = false;
  214. port = get_uint16(src);
  215. ipv4 = get_uint32(src);
  216. if (ipv4 >= SOCKS4A_NAME_FOLLOWS_BASE &&
  217. ipv4 < SOCKS4A_NAME_FOLLOWS_LIMIT) {
  218. /*
  219. * Addresses in this range indicate the SOCKS 4A
  220. * extension to specify a hostname, which comes
  221. * after the username.
  222. */
  223. name_based = true;
  224. }
  225. get_asciz(src); /* skip username */
  226. socks4_hostname = name_based ? get_asciz(src) : NULL;
  227. if (get_err(src) == BSE_OUT_OF_DATA)
  228. return;
  229. if (get_err(src))
  230. goto socks4_reject;
  231. pf->port = port;
  232. if (name_based) {
  233. pf->hostname = dupstr(socks4_hostname);
  234. } else {
  235. pf->hostname = ipv4_to_string(ipv4);
  236. }
  237. output = strbuf_new();
  238. put_byte(output, SOCKS4_REPLY_VERSION);
  239. put_byte(output, SOCKS4_RESP_SUCCESS);
  240. put_uint16(output, 0); /* null port field */
  241. put_uint32(output, 0); /* null address field */
  242. sk_write(pf->s, output->u, output->len);
  243. strbuf_free(output);
  244. pf->socks_state = SOCKS_NONE;
  245. pf->socksbuf_consumed = src->pos;
  246. break;
  247. }
  248. socks4_reject:
  249. output = strbuf_new();
  250. put_byte(output, SOCKS4_REPLY_VERSION);
  251. put_byte(output, SOCKS4_RESP_FAILURE);
  252. put_uint16(output, 0); /* null port field */
  253. put_uint32(output, 0); /* null address field */
  254. sk_write(pf->s, output->u, output->len);
  255. strbuf_free(output);
  256. pfd_close(pf);
  257. return;
  258. case SOCKS_5_INITIAL:
  259. /* SOCKS 5 initial method list */
  260. socks_version = get_byte(src);
  261. methods = get_pstring(src);
  262. method = SOCKS5_AUTH_REJECTED;
  263. /* Search the method list for AUTH_NONE, which is the
  264. * only one this client code can speak */
  265. { // WINSCP
  266. size_t i;
  267. for (i = 0; i < methods.len; i++) {
  268. unsigned char this_method =
  269. ((const unsigned char *)methods.ptr)[i];
  270. if (this_method == SOCKS5_AUTH_NONE) {
  271. method = this_method;
  272. break;
  273. }
  274. }
  275. if (get_err(src) == BSE_OUT_OF_DATA)
  276. return;
  277. if (get_err(src))
  278. method = SOCKS5_AUTH_REJECTED;
  279. output = strbuf_new();
  280. put_byte(output, SOCKS5_REPLY_VERSION);
  281. put_byte(output, method);
  282. sk_write(pf->s, output->u, output->len);
  283. strbuf_free(output);
  284. if (method == SOCKS5_AUTH_REJECTED) {
  285. pfd_close(pf);
  286. return;
  287. }
  288. pf->socks_state = SOCKS_5_CONNECT;
  289. pf->socksbuf_consumed = src->pos;
  290. break;
  291. } // WINSCP
  292. case SOCKS_5_CONNECT:
  293. /* SOCKS 5 connect message */
  294. socks_version = get_byte(src);
  295. message_type = get_byte(src);
  296. reserved_byte = get_byte(src);
  297. if (socks_version == SOCKS5_REQUEST_VERSION &&
  298. message_type == SOCKS_CMD_CONNECT &&
  299. reserved_byte == 0) {
  300. reply_code = SOCKS5_RESP_SUCCESS;
  301. switch (get_byte(src)) {
  302. case SOCKS5_ADDR_IPV4:
  303. pf->hostname = ipv4_to_string(get_uint32(src));
  304. break;
  305. case SOCKS5_ADDR_IPV6:
  306. pf->hostname = ipv6_to_string(get_data(src, 16));
  307. break;
  308. case SOCKS5_ADDR_HOSTNAME:
  309. pf->hostname = mkstr(get_pstring(src));
  310. break;
  311. default:
  312. pf->hostname = NULL;
  313. reply_code = SOCKS5_RESP_ADDRTYPE_NOT_SUPPORTED;
  314. break;
  315. }
  316. pf->port = get_uint16(src);
  317. } else {
  318. reply_code = SOCKS5_RESP_COMMAND_NOT_SUPPORTED;
  319. }
  320. if (get_err(src) == BSE_OUT_OF_DATA)
  321. return;
  322. if (get_err(src))
  323. reply_code = SOCKS5_RESP_FAILURE;
  324. output = strbuf_new();
  325. put_byte(output, SOCKS5_REPLY_VERSION);
  326. put_byte(output, reply_code);
  327. put_byte(output, 0); /* reserved */
  328. put_byte(output, SOCKS5_ADDR_IPV4); /* IPv4 address follows */
  329. put_uint32(output, 0); /* bound IPv4 address (unused) */
  330. put_uint16(output, 0); /* bound port number (unused) */
  331. sk_write(pf->s, output->u, output->len);
  332. strbuf_free(output);
  333. if (reply_code != SOCKS5_RESP_SUCCESS) {
  334. pfd_close(pf);
  335. return;
  336. }
  337. pf->socks_state = SOCKS_NONE;
  338. pf->socksbuf_consumed = src->pos;
  339. break;
  340. }
  341. }
  342. /*
  343. * We come here when we're ready to make an actual
  344. * connection.
  345. */
  346. /*
  347. * Freeze the socket until the SSH server confirms the
  348. * connection.
  349. */
  350. sk_set_frozen(pf->s, true);
  351. pf->c = wrap_lportfwd_open(pf->cl, pf->hostname, pf->port, pf->s,
  352. &pf->chan);
  353. }
  354. if (pf->ready)
  355. sshfwd_write(pf->c, data, len);
  356. }
  357. static void pfd_sent(Plug *plug, size_t bufsize)
  358. {
  359. struct PortForwarding *pf =
  360. container_of(plug, struct PortForwarding, plug);
  361. if (pf->c)
  362. sshfwd_unthrottle(pf->c, bufsize);
  363. }
  364. static const PlugVtable PortForwarding_plugvt = {
  365. // WINSCP
  366. /*.log =*/ nullplug_log,
  367. /*.closing =*/ pfd_closing,
  368. /*.receive =*/ pfd_receive,
  369. /*.sent =*/ pfd_sent,
  370. NULL,
  371. };
  372. static void pfd_chan_free(Channel *chan);
  373. static void pfd_open_confirmation(Channel *chan);
  374. static void pfd_open_failure(Channel *chan, const char *errtext);
  375. static size_t pfd_send(
  376. Channel *chan, bool is_stderr, const void *data, size_t len);
  377. static void pfd_send_eof(Channel *chan);
  378. static void pfd_set_input_wanted(Channel *chan, bool wanted);
  379. static char *pfd_log_close_msg(Channel *chan);
  380. static const ChannelVtable PortForwarding_channelvt = {
  381. // WINSCP
  382. /*.free =*/ pfd_chan_free,
  383. /*.open_confirmation =*/ pfd_open_confirmation,
  384. /*.open_failed =*/ pfd_open_failure,
  385. /*.send =*/ pfd_send,
  386. /*.send_eof =*/ pfd_send_eof,
  387. /*.set_input_wanted =*/ pfd_set_input_wanted,
  388. /*.log_close_msg =*/ pfd_log_close_msg,
  389. /*.want_close =*/ chan_default_want_close,
  390. /*.rcvd_exit_status =*/ chan_no_exit_status,
  391. /*.rcvd_exit_signal =*/ chan_no_exit_signal,
  392. /*.rcvd_exit_signal_numeric =*/ chan_no_exit_signal_numeric,
  393. /*.run_shell =*/ chan_no_run_shell,
  394. /*.run_command =*/ chan_no_run_command,
  395. /*.run_subsystem =*/ chan_no_run_subsystem,
  396. /*.enable_x11_forwarding =*/ chan_no_enable_x11_forwarding,
  397. /*.enable_agent_forwarding =*/ chan_no_enable_agent_forwarding,
  398. /*.allocate_pty =*/ chan_no_allocate_pty,
  399. /*.set_env =*/ chan_no_set_env,
  400. /*.send_break =*/ chan_no_send_break,
  401. /*.send_signal =*/ chan_no_send_signal,
  402. /*.change_window_size =*/ chan_no_change_window_size,
  403. /*.request_response =*/ chan_no_request_response,
  404. };
  405. Channel *portfwd_raw_new(ConnectionLayer *cl, Plug **plug, bool start_ready)
  406. {
  407. struct PortForwarding *pf;
  408. pf = new_portfwd_state();
  409. pf->plug.vt = &PortForwarding_plugvt;
  410. pf->chan.initial_fixed_window_size = 0;
  411. pf->chan.vt = &PortForwarding_channelvt;
  412. pf->input_wanted = true;
  413. pf->c = NULL;
  414. pf->cl = cl;
  415. pf->input_wanted = true;
  416. pf->ready = start_ready;
  417. pf->socks_state = SOCKS_NONE;
  418. pf->hostname = NULL;
  419. pf->port = 0;
  420. *plug = &pf->plug;
  421. return &pf->chan;
  422. }
  423. void portfwd_raw_free(Channel *pfchan)
  424. {
  425. struct PortForwarding *pf;
  426. assert(pfchan->vt == &PortForwarding_channelvt);
  427. pf = container_of(pfchan, struct PortForwarding, chan);
  428. free_portfwd_state(pf);
  429. }
  430. void portfwd_raw_setup(Channel *pfchan, Socket *s, SshChannel *sc)
  431. {
  432. struct PortForwarding *pf;
  433. assert(pfchan->vt == &PortForwarding_channelvt);
  434. pf = container_of(pfchan, struct PortForwarding, chan);
  435. pf->s = s;
  436. pf->c = sc;
  437. }
  438. /*
  439. * called when someone connects to the local port
  440. */
  441. static int pfl_accepting(Plug *p, accept_fn_t constructor, accept_ctx_t ctx)
  442. {
  443. struct PortListener *pl = container_of(p, struct PortListener, plug);
  444. struct PortForwarding *pf;
  445. Channel *chan;
  446. Plug *plug;
  447. Socket *s;
  448. const char *err;
  449. chan = portfwd_raw_new(pl->cl, &plug, false);
  450. s = constructor(ctx, plug);
  451. if ((err = sk_socket_error(s)) != NULL) {
  452. portfwd_raw_free(chan);
  453. return 1;
  454. }
  455. pf = container_of(chan, struct PortForwarding, chan);
  456. if (pl->is_dynamic) {
  457. pf->s = s;
  458. pf->socks_state = SOCKS_INITIAL;
  459. pf->socksbuf = strbuf_new();
  460. pf->socksbuf_consumed = 0;
  461. pf->port = 0; /* "hostname" buffer is so far empty */
  462. sk_set_frozen(s, false); /* we want to receive SOCKS _now_! */
  463. } else {
  464. pf->hostname = dupstr(pl->hostname);
  465. pf->port = pl->port;
  466. portfwd_raw_setup(
  467. chan, s,
  468. wrap_lportfwd_open(pl->cl, pf->hostname, pf->port, s, &pf->chan));
  469. }
  470. return 0;
  471. }
  472. static const PlugVtable PortListener_plugvt = {
  473. // WINSCP
  474. /*.log =*/ nullplug_log,
  475. /*.closing =*/ pfl_closing,
  476. NULL,
  477. NULL,
  478. /*.accepting =*/ pfl_accepting,
  479. };
  480. /*
  481. * Add a new port-forwarding listener from srcaddr:port -> desthost:destport.
  482. *
  483. * desthost == NULL indicates dynamic SOCKS port forwarding.
  484. *
  485. * On success, returns NULL and fills in *pl_ret. On error, returns a
  486. * dynamically allocated error message string.
  487. */
  488. static char *pfl_listen(const char *desthost, int destport,
  489. const char *srcaddr, int port,
  490. ConnectionLayer *cl, Conf *conf,
  491. struct PortListener **pl_ret, int address_family)
  492. {
  493. const char *err;
  494. struct PortListener *pl;
  495. /*
  496. * Open socket.
  497. */
  498. pl = *pl_ret = new_portlistener_state();
  499. pl->plug.vt = &PortListener_plugvt;
  500. if (desthost) {
  501. pl->hostname = dupstr(desthost);
  502. pl->port = destport;
  503. pl->is_dynamic = false;
  504. } else
  505. pl->is_dynamic = true;
  506. pl->cl = cl;
  507. pl->s = new_listener(srcaddr, port, &pl->plug,
  508. !conf_get_bool(conf, CONF_lport_acceptall),
  509. conf, address_family);
  510. if ((err = sk_socket_error(pl->s)) != NULL) {
  511. char *err_ret = dupstr(err);
  512. sk_close(pl->s);
  513. free_portlistener_state(pl);
  514. *pl_ret = NULL;
  515. return err_ret;
  516. }
  517. return NULL;
  518. }
  519. static char *pfd_log_close_msg(Channel *chan)
  520. {
  521. return dupstr("Forwarded port closed");
  522. }
  523. static void pfd_close(struct PortForwarding *pf)
  524. {
  525. if (!pf)
  526. return;
  527. sk_close(pf->s);
  528. free_portfwd_state(pf);
  529. }
  530. /*
  531. * Terminate a listener.
  532. */
  533. static void pfl_terminate(struct PortListener *pl)
  534. {
  535. if (!pl)
  536. return;
  537. sk_close(pl->s);
  538. free_portlistener_state(pl);
  539. }
  540. static void pfd_set_input_wanted(Channel *chan, bool wanted)
  541. {
  542. pinitassert(chan->vt == &PortForwarding_channelvt);
  543. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  544. pf->input_wanted = wanted;
  545. sk_set_frozen(pf->s, !pf->input_wanted);
  546. }
  547. static void pfd_chan_free(Channel *chan)
  548. {
  549. pinitassert(chan->vt == &PortForwarding_channelvt);
  550. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  551. pfd_close(pf);
  552. }
  553. /*
  554. * Called to send data down the raw connection.
  555. */
  556. static size_t pfd_send(
  557. Channel *chan, bool is_stderr, const void *data, size_t len)
  558. {
  559. pinitassert(chan->vt == &PortForwarding_channelvt);
  560. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  561. return sk_write(pf->s, data, len);
  562. }
  563. static void pfd_send_eof(Channel *chan)
  564. {
  565. pinitassert(chan->vt == &PortForwarding_channelvt);
  566. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  567. sk_write_eof(pf->s);
  568. }
  569. static void pfd_open_confirmation(Channel *chan)
  570. {
  571. pinitassert(chan->vt == &PortForwarding_channelvt);
  572. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  573. pf->ready = true;
  574. sk_set_frozen(pf->s, false);
  575. sk_write(pf->s, NULL, 0);
  576. if (pf->socksbuf) {
  577. sshfwd_write(pf->c, pf->socksbuf->u + pf->socksbuf_consumed,
  578. pf->socksbuf->len - pf->socksbuf_consumed);
  579. strbuf_free(pf->socksbuf);
  580. pf->socksbuf = NULL;
  581. }
  582. }
  583. static void pfd_open_failure(Channel *chan, const char *errtext)
  584. {
  585. pinitassert(chan->vt == &PortForwarding_channelvt);
  586. PortForwarding *pf = container_of(chan, PortForwarding, chan);
  587. logeventf(pf->cl->logctx,
  588. "Forwarded connection refused by remote%s%s",
  589. errtext ? ": " : "", errtext ? errtext : "");
  590. }
  591. /* ----------------------------------------------------------------------
  592. * Code to manage the complete set of currently active port
  593. * forwardings, and update it from Conf.
  594. */
  595. struct PortFwdRecord {
  596. enum { DESTROY, KEEP, CREATE } status;
  597. int type;
  598. unsigned sport, dport;
  599. char *saddr, *daddr;
  600. char *sserv, *dserv;
  601. struct ssh_rportfwd *remote;
  602. int addressfamily;
  603. struct PortListener *local;
  604. };
  605. static int pfr_cmp(void *av, void *bv)
  606. {
  607. PortFwdRecord *a = (PortFwdRecord *) av;
  608. PortFwdRecord *b = (PortFwdRecord *) bv;
  609. int i;
  610. if (a->type > b->type)
  611. return +1;
  612. if (a->type < b->type)
  613. return -1;
  614. if (a->addressfamily > b->addressfamily)
  615. return +1;
  616. if (a->addressfamily < b->addressfamily)
  617. return -1;
  618. if ( (i = nullstrcmp(a->saddr, b->saddr)) != 0)
  619. return i < 0 ? -1 : +1;
  620. if (a->sport > b->sport)
  621. return +1;
  622. if (a->sport < b->sport)
  623. return -1;
  624. if (a->type != 'D') {
  625. if ( (i = nullstrcmp(a->daddr, b->daddr)) != 0)
  626. return i < 0 ? -1 : +1;
  627. if (a->dport > b->dport)
  628. return +1;
  629. if (a->dport < b->dport)
  630. return -1;
  631. }
  632. return 0;
  633. }
  634. static void pfr_free(PortFwdRecord *pfr)
  635. {
  636. /* Dispose of any listening socket. */
  637. if (pfr->local)
  638. pfl_terminate(pfr->local);
  639. sfree(pfr->saddr);
  640. sfree(pfr->daddr);
  641. sfree(pfr->sserv);
  642. sfree(pfr->dserv);
  643. sfree(pfr);
  644. }
  645. struct PortFwdManager {
  646. ConnectionLayer *cl;
  647. Conf *conf;
  648. tree234 *forwardings;
  649. };
  650. PortFwdManager *portfwdmgr_new(ConnectionLayer *cl)
  651. {
  652. PortFwdManager *mgr = snew(PortFwdManager);
  653. mgr->cl = cl;
  654. mgr->conf = NULL;
  655. mgr->forwardings = newtree234(pfr_cmp);
  656. return mgr;
  657. }
  658. void portfwdmgr_close(PortFwdManager *mgr, PortFwdRecord *pfr)
  659. {
  660. PortFwdRecord *realpfr = del234(mgr->forwardings, pfr);
  661. if (realpfr == pfr)
  662. pfr_free(pfr);
  663. }
  664. void portfwdmgr_close_all(PortFwdManager *mgr)
  665. {
  666. PortFwdRecord *pfr;
  667. while ((pfr = delpos234(mgr->forwardings, 0)) != NULL)
  668. pfr_free(pfr);
  669. }
  670. void portfwdmgr_free(PortFwdManager *mgr)
  671. {
  672. portfwdmgr_close_all(mgr);
  673. freetree234(mgr->forwardings);
  674. if (mgr->conf)
  675. conf_free(mgr->conf);
  676. sfree(mgr);
  677. }
  678. void portfwdmgr_config(PortFwdManager *mgr, Conf *conf)
  679. {
  680. PortFwdRecord *pfr;
  681. int i;
  682. char *key, *val;
  683. if (mgr->conf)
  684. conf_free(mgr->conf);
  685. mgr->conf = conf_copy(conf);
  686. /*
  687. * Go through the existing port forwardings and tag them
  688. * with status==DESTROY. Any that we want to keep will be
  689. * re-enabled (status==KEEP) as we go through the
  690. * configuration and find out which bits are the same as
  691. * they were before.
  692. */
  693. for (i = 0; (pfr = index234(mgr->forwardings, i)) != NULL; i++)
  694. pfr->status = DESTROY;
  695. for (val = conf_get_str_strs(conf, CONF_portfwd, NULL, &key);
  696. val != NULL;
  697. val = conf_get_str_strs(conf, CONF_portfwd, key, &key)) {
  698. char *kp, *kp2, *vp, *vp2;
  699. char address_family, type;
  700. int sport, dport, sserv, dserv;
  701. char *sports, *dports, *saddr, *host;
  702. kp = key;
  703. address_family = 'A';
  704. type = 'L';
  705. if (*kp == 'A' || *kp == '4' || *kp == '6')
  706. address_family = *kp++;
  707. if (*kp == 'L' || *kp == 'R')
  708. type = *kp++;
  709. if ((kp2 = host_strchr(kp, ':')) != NULL) {
  710. /*
  711. * There's a colon in the middle of the source port
  712. * string, which means that the part before it is
  713. * actually a source address.
  714. */
  715. char *saddr_tmp = dupprintf("%.*s", (int)(kp2 - kp), kp);
  716. saddr = host_strduptrim(saddr_tmp);
  717. sfree(saddr_tmp);
  718. sports = kp2+1;
  719. } else {
  720. saddr = NULL;
  721. sports = kp;
  722. }
  723. sport = atoi(sports);
  724. sserv = 0;
  725. if (sport == 0) {
  726. sserv = 1;
  727. sport = net_service_lookup(sports);
  728. if (!sport) {
  729. logeventf(mgr->cl->logctx, "Service lookup failed for source"
  730. " port \"%s\"", sports);
  731. }
  732. }
  733. if (type == 'L' && !strcmp(val, "D")) {
  734. /* dynamic forwarding */
  735. host = NULL;
  736. dports = NULL;
  737. dport = -1;
  738. dserv = 0;
  739. type = 'D';
  740. } else {
  741. /* ordinary forwarding */
  742. vp = val;
  743. vp2 = vp + host_strcspn(vp, ":");
  744. host = dupprintf("%.*s", (int)(vp2 - vp), vp);
  745. if (*vp2)
  746. vp2++;
  747. dports = vp2;
  748. dport = atoi(dports);
  749. dserv = 0;
  750. if (dport == 0) {
  751. dserv = 1;
  752. dport = net_service_lookup(dports);
  753. if (!dport) {
  754. logeventf(mgr->cl->logctx,
  755. "Service lookup failed for destination"
  756. " port \"%s\"", dports);
  757. }
  758. }
  759. }
  760. if (sport && dport) {
  761. /* Set up a description of the source port. */
  762. pfr = snew(PortFwdRecord);
  763. pfr->type = type;
  764. pfr->saddr = saddr;
  765. pfr->sserv = sserv ? dupstr(sports) : NULL;
  766. pfr->sport = sport;
  767. pfr->daddr = host;
  768. pfr->dserv = dserv ? dupstr(dports) : NULL;
  769. pfr->dport = dport;
  770. pfr->local = NULL;
  771. pfr->remote = NULL;
  772. pfr->addressfamily = (address_family == '4' ? ADDRTYPE_IPV4 :
  773. address_family == '6' ? ADDRTYPE_IPV6 :
  774. ADDRTYPE_UNSPEC);
  775. { // WINSCP
  776. PortFwdRecord *existing = add234(mgr->forwardings, pfr);
  777. if (existing != pfr) {
  778. if (existing->status == DESTROY) {
  779. /*
  780. * We already have a port forwarding up and running
  781. * with precisely these parameters. Hence, no need
  782. * to do anything; simply re-tag the existing one
  783. * as KEEP.
  784. */
  785. existing->status = KEEP;
  786. }
  787. /*
  788. * Anything else indicates that there was a duplicate
  789. * in our input, which we'll silently ignore.
  790. */
  791. pfr_free(pfr);
  792. } else {
  793. pfr->status = CREATE;
  794. }
  795. } // WINSCP
  796. } else {
  797. sfree(saddr);
  798. sfree(host);
  799. }
  800. }
  801. /*
  802. * Now go through and destroy any port forwardings which were
  803. * not re-enabled.
  804. */
  805. for (i = 0; (pfr = index234(mgr->forwardings, i)) != NULL; i++) {
  806. if (pfr->status == DESTROY) {
  807. char *message;
  808. message = dupprintf("%s port forwarding from %s%s%d",
  809. pfr->type == 'L' ? "local" :
  810. pfr->type == 'R' ? "remote" : "dynamic",
  811. pfr->saddr ? pfr->saddr : "",
  812. pfr->saddr ? ":" : "",
  813. pfr->sport);
  814. if (pfr->type != 'D') {
  815. char *msg2 = dupprintf("%s to %s:%d", message,
  816. pfr->daddr, pfr->dport);
  817. sfree(message);
  818. message = msg2;
  819. }
  820. logeventf(mgr->cl->logctx, "Cancelling %s", message);
  821. sfree(message);
  822. /* pfr->remote or pfr->local may be NULL if setting up a
  823. * forwarding failed. */
  824. if (pfr->remote) {
  825. /*
  826. * Cancel the port forwarding at the server
  827. * end.
  828. *
  829. * Actually closing the listening port on the server
  830. * side may fail - because in SSH-1 there's no message
  831. * in the protocol to request it!
  832. *
  833. * Instead, we simply remove the record of the
  834. * forwarding from our local end, so that any
  835. * connections the server tries to make on it are
  836. * rejected.
  837. */
  838. ssh_rportfwd_remove(mgr->cl, pfr->remote);
  839. pfr->remote = NULL;
  840. } else if (pfr->local) {
  841. pfl_terminate(pfr->local);
  842. pfr->local = NULL;
  843. }
  844. delpos234(mgr->forwardings, i);
  845. pfr_free(pfr);
  846. i--; /* so we don't skip one in the list */
  847. }
  848. }
  849. /*
  850. * And finally, set up any new port forwardings (status==CREATE).
  851. */
  852. for (i = 0; (pfr = index234(mgr->forwardings, i)) != NULL; i++) {
  853. if (pfr->status == CREATE) {
  854. char *sportdesc, *dportdesc;
  855. sportdesc = dupprintf("%s%s%s%s%d%s",
  856. pfr->saddr ? pfr->saddr : "",
  857. pfr->saddr ? ":" : "",
  858. pfr->sserv ? pfr->sserv : "",
  859. pfr->sserv ? "(" : "",
  860. pfr->sport,
  861. pfr->sserv ? ")" : "");
  862. if (pfr->type == 'D') {
  863. dportdesc = NULL;
  864. } else {
  865. dportdesc = dupprintf("%s:%s%s%d%s",
  866. pfr->daddr,
  867. pfr->dserv ? pfr->dserv : "",
  868. pfr->dserv ? "(" : "",
  869. pfr->dport,
  870. pfr->dserv ? ")" : "");
  871. }
  872. if (pfr->type == 'L') {
  873. char *err = pfl_listen(pfr->daddr, pfr->dport,
  874. pfr->saddr, pfr->sport,
  875. mgr->cl, conf, &pfr->local,
  876. pfr->addressfamily);
  877. logeventf(mgr->cl->logctx,
  878. "Local %sport %s forwarding to %s%s%s",
  879. pfr->addressfamily == ADDRTYPE_IPV4 ? "IPv4 " :
  880. pfr->addressfamily == ADDRTYPE_IPV6 ? "IPv6 " : "",
  881. sportdesc, dportdesc,
  882. err ? " failed: " : "", err ? err : "");
  883. if (err)
  884. sfree(err);
  885. } else if (pfr->type == 'D') {
  886. char *err = pfl_listen(NULL, -1, pfr->saddr, pfr->sport,
  887. mgr->cl, conf, &pfr->local,
  888. pfr->addressfamily);
  889. logeventf(mgr->cl->logctx,
  890. "Local %sport %s SOCKS dynamic forwarding%s%s",
  891. pfr->addressfamily == ADDRTYPE_IPV4 ? "IPv4 " :
  892. pfr->addressfamily == ADDRTYPE_IPV6 ? "IPv6 " : "",
  893. sportdesc,
  894. err ? " failed: " : "", err ? err : "");
  895. if (err)
  896. sfree(err);
  897. } else {
  898. const char *shost;
  899. if (pfr->saddr) {
  900. shost = pfr->saddr;
  901. } else if (conf_get_bool(conf, CONF_rport_acceptall)) {
  902. shost = "";
  903. } else {
  904. shost = "localhost";
  905. }
  906. pfr->remote = ssh_rportfwd_alloc(
  907. mgr->cl, shost, pfr->sport, pfr->daddr, pfr->dport,
  908. pfr->addressfamily, sportdesc, pfr, NULL);
  909. if (!pfr->remote) {
  910. logeventf(mgr->cl->logctx,
  911. "Duplicate remote port forwarding to %s:%d",
  912. pfr->daddr, pfr->dport);
  913. pfr_free(pfr);
  914. } else {
  915. logeventf(mgr->cl->logctx, "Requesting remote port %s"
  916. " forward to %s", sportdesc, dportdesc);
  917. }
  918. }
  919. sfree(sportdesc);
  920. sfree(dportdesc);
  921. }
  922. }
  923. }
  924. bool portfwdmgr_listen(PortFwdManager *mgr, const char *host, int port,
  925. const char *keyhost, int keyport, Conf *conf)
  926. {
  927. PortFwdRecord *pfr;
  928. pfr = snew(PortFwdRecord);
  929. pfr->type = 'L';
  930. pfr->saddr = host ? dupstr(host) : NULL;
  931. pfr->daddr = keyhost ? dupstr(keyhost) : NULL;
  932. pfr->sserv = pfr->dserv = NULL;
  933. pfr->sport = port;
  934. pfr->dport = keyport;
  935. pfr->local = NULL;
  936. pfr->remote = NULL;
  937. pfr->addressfamily = ADDRTYPE_UNSPEC;
  938. { // WINSCP
  939. PortFwdRecord *existing = add234(mgr->forwardings, pfr);
  940. if (existing != pfr) {
  941. /*
  942. * We had this record already. Return failure.
  943. */
  944. pfr_free(pfr);
  945. return false;
  946. }
  947. } // WINSCP
  948. { // WINSCP
  949. char *err = pfl_listen(keyhost, keyport, host, port,
  950. mgr->cl, conf, &pfr->local, pfr->addressfamily);
  951. logeventf(mgr->cl->logctx,
  952. "%s on port %s:%d to forward to client%s%s",
  953. err ? "Failed to listen" : "Listening", host, port,
  954. err ? ": " : "", err ? err : "");
  955. if (err) {
  956. sfree(err);
  957. del234(mgr->forwardings, pfr);
  958. pfr_free(pfr);
  959. return false;
  960. }
  961. } // WINSCP
  962. return true;
  963. }
  964. bool portfwdmgr_unlisten(PortFwdManager *mgr, const char *host, int port)
  965. {
  966. PortFwdRecord pfr_key;
  967. pfr_key.type = 'L';
  968. /* Safe to cast the const away here, because it will only be used
  969. * by pfr_cmp, which won't write to the string */
  970. pfr_key.saddr = pfr_key.daddr = (char *)host;
  971. pfr_key.sserv = pfr_key.dserv = NULL;
  972. pfr_key.sport = pfr_key.dport = port;
  973. pfr_key.local = NULL;
  974. pfr_key.remote = NULL;
  975. pfr_key.addressfamily = ADDRTYPE_UNSPEC;
  976. { // WINSCP
  977. PortFwdRecord *pfr = del234(mgr->forwardings, &pfr_key);
  978. if (!pfr)
  979. return false;
  980. logeventf(mgr->cl->logctx, "Closing listening port %s:%d", host, port);
  981. pfr_free(pfr);
  982. } // WINSCP
  983. return true;
  984. }
  985. /*
  986. * Called when receiving a PORT OPEN from the server to make a
  987. * connection to a destination host.
  988. *
  989. * On success, returns NULL and fills in *pf_ret. On error, returns a
  990. * dynamically allocated error message string.
  991. */
  992. char *portfwdmgr_connect(PortFwdManager *mgr, Channel **chan_ret,
  993. char *hostname, int port, SshChannel *c,
  994. int addressfamily)
  995. {
  996. SockAddr *addr;
  997. const char *err;
  998. char *dummy_realhost = NULL;
  999. struct PortForwarding *pf;
  1000. /*
  1001. * Try to find host.
  1002. */
  1003. addr = name_lookup(hostname, port, &dummy_realhost, mgr->conf,
  1004. addressfamily, NULL, NULL);
  1005. if ((err = sk_addr_error(addr)) != NULL) {
  1006. char *err_ret = dupstr(err);
  1007. sk_addr_free(addr);
  1008. sfree(dummy_realhost);
  1009. return err_ret;
  1010. }
  1011. /*
  1012. * Open socket.
  1013. */
  1014. pf = new_portfwd_state();
  1015. *chan_ret = &pf->chan;
  1016. pf->plug.vt = &PortForwarding_plugvt;
  1017. pf->chan.initial_fixed_window_size = 0;
  1018. pf->chan.vt = &PortForwarding_channelvt;
  1019. pf->input_wanted = true;
  1020. pf->ready = true;
  1021. pf->c = c;
  1022. pf->cl = mgr->cl;
  1023. pf->socks_state = SOCKS_NONE;
  1024. pf->s = new_connection(addr, dummy_realhost, port,
  1025. false, true, false, false, &pf->plug, mgr->conf,
  1026. NULL);
  1027. sfree(dummy_realhost);
  1028. if ((err = sk_socket_error(pf->s)) != NULL) {
  1029. char *err_ret = dupstr(err);
  1030. sk_close(pf->s);
  1031. free_portfwd_state(pf);
  1032. *chan_ret = NULL;
  1033. return err_ret;
  1034. }
  1035. return NULL;
  1036. }
  1037. #ifdef MPEXT
  1038. #include "puttyexp.h"
  1039. int is_pfwd(Plug * plug)
  1040. {
  1041. return
  1042. (plug->vt->closing == pfd_closing) ||
  1043. (plug->vt->closing == pfl_closing);
  1044. }
  1045. Seat * get_pfwd_seat(Plug * plug)
  1046. {
  1047. LogContext * logctx;
  1048. if (plug->vt->closing == pfl_closing)
  1049. {
  1050. struct PortListener *pl = container_of(plug, struct PortListener, plug);
  1051. logctx = pl->cl->logctx;
  1052. }
  1053. else if (plug->vt->closing == pfd_closing)
  1054. {
  1055. struct PortForwarding *pf = container_of(plug, struct PortForwarding, plug);
  1056. logctx = pf->cl->logctx;
  1057. }
  1058. return get_log_seat(logctx);
  1059. }
  1060. #endif