trans_fd.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131
  1. /*
  2. * linux/fs/9p/trans_fd.c
  3. *
  4. * Fd transport layer. Includes deprecated socket layer.
  5. *
  6. * Copyright (C) 2006 by Russ Cox <rsc@swtch.com>
  7. * Copyright (C) 2004-2005 by Latchesar Ionkov <lucho@ionkov.net>
  8. * Copyright (C) 2004-2008 by Eric Van Hensbergen <ericvh@gmail.com>
  9. * Copyright (C) 1997-2002 by Ron Minnich <rminnich@sarnoff.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License version 2
  13. * as published by the Free Software Foundation.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to:
  22. * Free Software Foundation
  23. * 51 Franklin Street, Fifth Floor
  24. * Boston, MA 02111-1301 USA
  25. *
  26. */
  27. #include <linux/in.h>
  28. #include <linux/module.h>
  29. #include <linux/net.h>
  30. #include <linux/ipv6.h>
  31. #include <linux/kthread.h>
  32. #include <linux/errno.h>
  33. #include <linux/kernel.h>
  34. #include <linux/un.h>
  35. #include <linux/uaccess.h>
  36. #include <linux/inet.h>
  37. #include <linux/idr.h>
  38. #include <linux/file.h>
  39. #include <linux/parser.h>
  40. #include <net/9p/9p.h>
  41. #include <net/9p/client.h>
  42. #include <net/9p/transport.h>
  43. #define P9_PORT 564
  44. #define MAX_SOCK_BUF (64*1024)
  45. #define MAXPOLLWADDR 2
  46. /**
  47. * struct p9_fd_opts - per-transport options
  48. * @rfd: file descriptor for reading (trans=fd)
  49. * @wfd: file descriptor for writing (trans=fd)
  50. * @port: port to connect to (trans=tcp)
  51. *
  52. */
  53. struct p9_fd_opts {
  54. int rfd;
  55. int wfd;
  56. u16 port;
  57. };
  58. /**
  59. * struct p9_trans_fd - transport state
  60. * @rd: reference to file to read from
  61. * @wr: reference of file to write to
  62. * @conn: connection state reference
  63. *
  64. */
  65. struct p9_trans_fd {
  66. struct file *rd;
  67. struct file *wr;
  68. struct p9_conn *conn;
  69. };
  70. /*
  71. * Option Parsing (code inspired by NFS code)
  72. * - a little lazy - parse all fd-transport options
  73. */
  74. enum {
  75. /* Options that take integer arguments */
  76. Opt_port, Opt_rfdno, Opt_wfdno, Opt_err,
  77. };
  78. static const match_table_t tokens = {
  79. {Opt_port, "port=%u"},
  80. {Opt_rfdno, "rfdno=%u"},
  81. {Opt_wfdno, "wfdno=%u"},
  82. {Opt_err, NULL},
  83. };
  84. enum {
  85. Rworksched = 1, /* read work scheduled or running */
  86. Rpending = 2, /* can read */
  87. Wworksched = 4, /* write work scheduled or running */
  88. Wpending = 8, /* can write */
  89. };
  90. struct p9_poll_wait {
  91. struct p9_conn *conn;
  92. wait_queue_t wait;
  93. wait_queue_head_t *wait_addr;
  94. };
  95. /**
  96. * struct p9_conn - fd mux connection state information
  97. * @mux_list: list link for mux to manage multiple connections (?)
  98. * @client: reference to client instance for this connection
  99. * @err: error state
  100. * @req_list: accounting for requests which have been sent
  101. * @unsent_req_list: accounting for requests that haven't been sent
  102. * @req: current request being processed (if any)
  103. * @tmp_buf: temporary buffer to read in header
  104. * @rsize: amount to read for current frame
  105. * @rpos: read position in current frame
  106. * @rbuf: current read buffer
  107. * @wpos: write position for current frame
  108. * @wsize: amount of data to write for current frame
  109. * @wbuf: current write buffer
  110. * @poll_pending_link: pending links to be polled per conn
  111. * @poll_wait: array of wait_q's for various worker threads
  112. * @pt: poll state
  113. * @rq: current read work
  114. * @wq: current write work
  115. * @wsched: ????
  116. *
  117. */
  118. struct p9_conn {
  119. struct list_head mux_list;
  120. struct p9_client *client;
  121. int err;
  122. struct list_head req_list;
  123. struct list_head unsent_req_list;
  124. struct p9_req_t *req;
  125. char tmp_buf[7];
  126. int rsize;
  127. int rpos;
  128. char *rbuf;
  129. int wpos;
  130. int wsize;
  131. char *wbuf;
  132. struct list_head poll_pending_link;
  133. struct p9_poll_wait poll_wait[MAXPOLLWADDR];
  134. poll_table pt;
  135. struct work_struct rq;
  136. struct work_struct wq;
  137. unsigned long wsched;
  138. };
  139. static DEFINE_SPINLOCK(p9_poll_lock);
  140. static LIST_HEAD(p9_poll_pending_list);
  141. static struct workqueue_struct *p9_mux_wq;
  142. static struct task_struct *p9_poll_task;
  143. static void p9_mux_poll_stop(struct p9_conn *m)
  144. {
  145. unsigned long flags;
  146. int i;
  147. for (i = 0; i < ARRAY_SIZE(m->poll_wait); i++) {
  148. struct p9_poll_wait *pwait = &m->poll_wait[i];
  149. if (pwait->wait_addr) {
  150. remove_wait_queue(pwait->wait_addr, &pwait->wait);
  151. pwait->wait_addr = NULL;
  152. }
  153. }
  154. spin_lock_irqsave(&p9_poll_lock, flags);
  155. list_del_init(&m->poll_pending_link);
  156. spin_unlock_irqrestore(&p9_poll_lock, flags);
  157. }
  158. /**
  159. * p9_conn_cancel - cancel all pending requests with error
  160. * @m: mux data
  161. * @err: error code
  162. *
  163. */
  164. static void p9_conn_cancel(struct p9_conn *m, int err)
  165. {
  166. struct p9_req_t *req, *rtmp;
  167. unsigned long flags;
  168. LIST_HEAD(cancel_list);
  169. P9_DPRINTK(P9_DEBUG_ERROR, "mux %p err %d\n", m, err);
  170. spin_lock_irqsave(&m->client->lock, flags);
  171. if (m->err) {
  172. spin_unlock_irqrestore(&m->client->lock, flags);
  173. return;
  174. }
  175. m->err = err;
  176. list_for_each_entry_safe(req, rtmp, &m->req_list, req_list) {
  177. req->status = REQ_STATUS_ERROR;
  178. if (!req->t_err)
  179. req->t_err = err;
  180. list_move(&req->req_list, &cancel_list);
  181. }
  182. list_for_each_entry_safe(req, rtmp, &m->unsent_req_list, req_list) {
  183. req->status = REQ_STATUS_ERROR;
  184. if (!req->t_err)
  185. req->t_err = err;
  186. list_move(&req->req_list, &cancel_list);
  187. }
  188. spin_unlock_irqrestore(&m->client->lock, flags);
  189. list_for_each_entry_safe(req, rtmp, &cancel_list, req_list) {
  190. P9_DPRINTK(P9_DEBUG_ERROR, "call back req %p\n", req);
  191. list_del(&req->req_list);
  192. p9_client_cb(m->client, req);
  193. }
  194. }
  195. static unsigned int
  196. p9_fd_poll(struct p9_client *client, struct poll_table_struct *pt)
  197. {
  198. int ret, n;
  199. struct p9_trans_fd *ts = NULL;
  200. if (client && client->status == Connected)
  201. ts = client->trans;
  202. if (!ts)
  203. return -EREMOTEIO;
  204. if (!ts->rd->f_op || !ts->rd->f_op->poll)
  205. return -EIO;
  206. if (!ts->wr->f_op || !ts->wr->f_op->poll)
  207. return -EIO;
  208. ret = ts->rd->f_op->poll(ts->rd, pt);
  209. if (ret < 0)
  210. return ret;
  211. if (ts->rd != ts->wr) {
  212. n = ts->wr->f_op->poll(ts->wr, pt);
  213. if (n < 0)
  214. return n;
  215. ret = (ret & ~POLLOUT) | (n & ~POLLIN);
  216. }
  217. return ret;
  218. }
  219. /**
  220. * p9_fd_read- read from a fd
  221. * @client: client instance
  222. * @v: buffer to receive data into
  223. * @len: size of receive buffer
  224. *
  225. */
  226. static int p9_fd_read(struct p9_client *client, void *v, int len)
  227. {
  228. int ret;
  229. struct p9_trans_fd *ts = NULL;
  230. if (client && client->status != Disconnected)
  231. ts = client->trans;
  232. if (!ts)
  233. return -EREMOTEIO;
  234. if (!(ts->rd->f_flags & O_NONBLOCK))
  235. P9_DPRINTK(P9_DEBUG_ERROR, "blocking read ...\n");
  236. ret = kernel_read(ts->rd, ts->rd->f_pos, v, len);
  237. if (ret <= 0 && ret != -ERESTARTSYS && ret != -EAGAIN)
  238. client->status = Disconnected;
  239. return ret;
  240. }
  241. /**
  242. * p9_read_work - called when there is some data to be read from a transport
  243. * @work: container of work to be done
  244. *
  245. */
  246. static void p9_read_work(struct work_struct *work)
  247. {
  248. int n, err;
  249. struct p9_conn *m;
  250. m = container_of(work, struct p9_conn, rq);
  251. if (m->err < 0)
  252. return;
  253. P9_DPRINTK(P9_DEBUG_TRANS, "start mux %p pos %d\n", m, m->rpos);
  254. if (!m->rbuf) {
  255. m->rbuf = m->tmp_buf;
  256. m->rpos = 0;
  257. m->rsize = 7; /* start by reading header */
  258. }
  259. clear_bit(Rpending, &m->wsched);
  260. P9_DPRINTK(P9_DEBUG_TRANS, "read mux %p pos %d size: %d = %d\n", m,
  261. m->rpos, m->rsize, m->rsize-m->rpos);
  262. err = p9_fd_read(m->client, m->rbuf + m->rpos,
  263. m->rsize - m->rpos);
  264. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p got %d bytes\n", m, err);
  265. if (err == -EAGAIN) {
  266. clear_bit(Rworksched, &m->wsched);
  267. return;
  268. }
  269. if (err <= 0)
  270. goto error;
  271. m->rpos += err;
  272. if ((!m->req) && (m->rpos == m->rsize)) { /* header read in */
  273. u16 tag;
  274. P9_DPRINTK(P9_DEBUG_TRANS, "got new header\n");
  275. n = le32_to_cpu(*(__le32 *) m->rbuf); /* read packet size */
  276. if (n >= m->client->msize) {
  277. P9_DPRINTK(P9_DEBUG_ERROR,
  278. "requested packet size too big: %d\n", n);
  279. err = -EIO;
  280. goto error;
  281. }
  282. tag = le16_to_cpu(*(__le16 *) (m->rbuf+5)); /* read tag */
  283. P9_DPRINTK(P9_DEBUG_TRANS,
  284. "mux %p pkt: size: %d bytes tag: %d\n", m, n, tag);
  285. m->req = p9_tag_lookup(m->client, tag);
  286. if (!m->req || (m->req->status != REQ_STATUS_SENT &&
  287. m->req->status != REQ_STATUS_FLSH)) {
  288. P9_DPRINTK(P9_DEBUG_ERROR, "Unexpected packet tag %d\n",
  289. tag);
  290. err = -EIO;
  291. goto error;
  292. }
  293. if (m->req->rc == NULL) {
  294. m->req->rc = kmalloc(sizeof(struct p9_fcall) +
  295. m->client->msize, GFP_KERNEL);
  296. if (!m->req->rc) {
  297. m->req = NULL;
  298. err = -ENOMEM;
  299. goto error;
  300. }
  301. }
  302. m->rbuf = (char *)m->req->rc + sizeof(struct p9_fcall);
  303. memcpy(m->rbuf, m->tmp_buf, m->rsize);
  304. m->rsize = n;
  305. }
  306. /* not an else because some packets (like clunk) have no payload */
  307. if ((m->req) && (m->rpos == m->rsize)) { /* packet is read in */
  308. P9_DPRINTK(P9_DEBUG_TRANS, "got new packet\n");
  309. spin_lock(&m->client->lock);
  310. if (m->req->status != REQ_STATUS_ERROR)
  311. m->req->status = REQ_STATUS_RCVD;
  312. list_del(&m->req->req_list);
  313. spin_unlock(&m->client->lock);
  314. p9_client_cb(m->client, m->req);
  315. m->rbuf = NULL;
  316. m->rpos = 0;
  317. m->rsize = 0;
  318. m->req = NULL;
  319. }
  320. if (!list_empty(&m->req_list)) {
  321. if (test_and_clear_bit(Rpending, &m->wsched))
  322. n = POLLIN;
  323. else
  324. n = p9_fd_poll(m->client, NULL);
  325. if (n & POLLIN) {
  326. P9_DPRINTK(P9_DEBUG_TRANS, "sched read work %p\n", m);
  327. queue_work(p9_mux_wq, &m->rq);
  328. } else
  329. clear_bit(Rworksched, &m->wsched);
  330. } else
  331. clear_bit(Rworksched, &m->wsched);
  332. return;
  333. error:
  334. p9_conn_cancel(m, err);
  335. clear_bit(Rworksched, &m->wsched);
  336. }
  337. /**
  338. * p9_fd_write - write to a socket
  339. * @client: client instance
  340. * @v: buffer to send data from
  341. * @len: size of send buffer
  342. *
  343. */
  344. static int p9_fd_write(struct p9_client *client, void *v, int len)
  345. {
  346. int ret;
  347. mm_segment_t oldfs;
  348. struct p9_trans_fd *ts = NULL;
  349. if (client && client->status != Disconnected)
  350. ts = client->trans;
  351. if (!ts)
  352. return -EREMOTEIO;
  353. if (!(ts->wr->f_flags & O_NONBLOCK))
  354. P9_DPRINTK(P9_DEBUG_ERROR, "blocking write ...\n");
  355. oldfs = get_fs();
  356. set_fs(get_ds());
  357. /* The cast to a user pointer is valid due to the set_fs() */
  358. ret = vfs_write(ts->wr, (__force void __user *)v, len, &ts->wr->f_pos);
  359. set_fs(oldfs);
  360. if (ret <= 0 && ret != -ERESTARTSYS && ret != -EAGAIN)
  361. client->status = Disconnected;
  362. return ret;
  363. }
  364. /**
  365. * p9_write_work - called when a transport can send some data
  366. * @work: container for work to be done
  367. *
  368. */
  369. static void p9_write_work(struct work_struct *work)
  370. {
  371. int n, err;
  372. struct p9_conn *m;
  373. struct p9_req_t *req;
  374. m = container_of(work, struct p9_conn, wq);
  375. if (m->err < 0) {
  376. clear_bit(Wworksched, &m->wsched);
  377. return;
  378. }
  379. if (!m->wsize) {
  380. if (list_empty(&m->unsent_req_list)) {
  381. clear_bit(Wworksched, &m->wsched);
  382. return;
  383. }
  384. spin_lock(&m->client->lock);
  385. req = list_entry(m->unsent_req_list.next, struct p9_req_t,
  386. req_list);
  387. req->status = REQ_STATUS_SENT;
  388. P9_DPRINTK(P9_DEBUG_TRANS, "move req %p\n", req);
  389. list_move_tail(&req->req_list, &m->req_list);
  390. m->wbuf = req->tc->sdata;
  391. m->wsize = req->tc->size;
  392. m->wpos = 0;
  393. spin_unlock(&m->client->lock);
  394. }
  395. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p pos %d size %d\n", m, m->wpos,
  396. m->wsize);
  397. clear_bit(Wpending, &m->wsched);
  398. err = p9_fd_write(m->client, m->wbuf + m->wpos, m->wsize - m->wpos);
  399. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p sent %d bytes\n", m, err);
  400. if (err == -EAGAIN) {
  401. clear_bit(Wworksched, &m->wsched);
  402. return;
  403. }
  404. if (err < 0)
  405. goto error;
  406. else if (err == 0) {
  407. err = -EREMOTEIO;
  408. goto error;
  409. }
  410. m->wpos += err;
  411. if (m->wpos == m->wsize)
  412. m->wpos = m->wsize = 0;
  413. if (m->wsize == 0 && !list_empty(&m->unsent_req_list)) {
  414. if (test_and_clear_bit(Wpending, &m->wsched))
  415. n = POLLOUT;
  416. else
  417. n = p9_fd_poll(m->client, NULL);
  418. if (n & POLLOUT) {
  419. P9_DPRINTK(P9_DEBUG_TRANS, "sched write work %p\n", m);
  420. queue_work(p9_mux_wq, &m->wq);
  421. } else
  422. clear_bit(Wworksched, &m->wsched);
  423. } else
  424. clear_bit(Wworksched, &m->wsched);
  425. return;
  426. error:
  427. p9_conn_cancel(m, err);
  428. clear_bit(Wworksched, &m->wsched);
  429. }
  430. static int p9_pollwake(wait_queue_t *wait, unsigned mode, int sync, void *key)
  431. {
  432. struct p9_poll_wait *pwait =
  433. container_of(wait, struct p9_poll_wait, wait);
  434. struct p9_conn *m = pwait->conn;
  435. unsigned long flags;
  436. DECLARE_WAITQUEUE(dummy_wait, p9_poll_task);
  437. spin_lock_irqsave(&p9_poll_lock, flags);
  438. if (list_empty(&m->poll_pending_link))
  439. list_add_tail(&m->poll_pending_link, &p9_poll_pending_list);
  440. spin_unlock_irqrestore(&p9_poll_lock, flags);
  441. /* perform the default wake up operation */
  442. return default_wake_function(&dummy_wait, mode, sync, key);
  443. }
  444. /**
  445. * p9_pollwait - add poll task to the wait queue
  446. * @filp: file pointer being polled
  447. * @wait_address: wait_q to block on
  448. * @p: poll state
  449. *
  450. * called by files poll operation to add v9fs-poll task to files wait queue
  451. */
  452. static void
  453. p9_pollwait(struct file *filp, wait_queue_head_t *wait_address, poll_table *p)
  454. {
  455. struct p9_conn *m = container_of(p, struct p9_conn, pt);
  456. struct p9_poll_wait *pwait = NULL;
  457. int i;
  458. for (i = 0; i < ARRAY_SIZE(m->poll_wait); i++) {
  459. if (m->poll_wait[i].wait_addr == NULL) {
  460. pwait = &m->poll_wait[i];
  461. break;
  462. }
  463. }
  464. if (!pwait) {
  465. P9_DPRINTK(P9_DEBUG_ERROR, "not enough wait_address slots\n");
  466. return;
  467. }
  468. pwait->conn = m;
  469. pwait->wait_addr = wait_address;
  470. init_waitqueue_func_entry(&pwait->wait, p9_pollwake);
  471. add_wait_queue(wait_address, &pwait->wait);
  472. }
  473. /**
  474. * p9_conn_create - allocate and initialize the per-session mux data
  475. * @client: client instance
  476. *
  477. * Note: Creates the polling task if this is the first session.
  478. */
  479. static struct p9_conn *p9_conn_create(struct p9_client *client)
  480. {
  481. int n;
  482. struct p9_conn *m;
  483. P9_DPRINTK(P9_DEBUG_TRANS, "client %p msize %d\n", client,
  484. client->msize);
  485. m = kzalloc(sizeof(struct p9_conn), GFP_KERNEL);
  486. if (!m)
  487. return ERR_PTR(-ENOMEM);
  488. INIT_LIST_HEAD(&m->mux_list);
  489. m->client = client;
  490. INIT_LIST_HEAD(&m->req_list);
  491. INIT_LIST_HEAD(&m->unsent_req_list);
  492. INIT_WORK(&m->rq, p9_read_work);
  493. INIT_WORK(&m->wq, p9_write_work);
  494. INIT_LIST_HEAD(&m->poll_pending_link);
  495. init_poll_funcptr(&m->pt, p9_pollwait);
  496. n = p9_fd_poll(client, &m->pt);
  497. if (n & POLLIN) {
  498. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p can read\n", m);
  499. set_bit(Rpending, &m->wsched);
  500. }
  501. if (n & POLLOUT) {
  502. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p can write\n", m);
  503. set_bit(Wpending, &m->wsched);
  504. }
  505. return m;
  506. }
  507. /**
  508. * p9_poll_mux - polls a mux and schedules read or write works if necessary
  509. * @m: connection to poll
  510. *
  511. */
  512. static void p9_poll_mux(struct p9_conn *m)
  513. {
  514. int n;
  515. if (m->err < 0)
  516. return;
  517. n = p9_fd_poll(m->client, NULL);
  518. if (n < 0 || n & (POLLERR | POLLHUP | POLLNVAL)) {
  519. P9_DPRINTK(P9_DEBUG_TRANS, "error mux %p err %d\n", m, n);
  520. if (n >= 0)
  521. n = -ECONNRESET;
  522. p9_conn_cancel(m, n);
  523. }
  524. if (n & POLLIN) {
  525. set_bit(Rpending, &m->wsched);
  526. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p can read\n", m);
  527. if (!test_and_set_bit(Rworksched, &m->wsched)) {
  528. P9_DPRINTK(P9_DEBUG_TRANS, "sched read work %p\n", m);
  529. queue_work(p9_mux_wq, &m->rq);
  530. }
  531. }
  532. if (n & POLLOUT) {
  533. set_bit(Wpending, &m->wsched);
  534. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p can write\n", m);
  535. if ((m->wsize || !list_empty(&m->unsent_req_list))
  536. && !test_and_set_bit(Wworksched, &m->wsched)) {
  537. P9_DPRINTK(P9_DEBUG_TRANS, "sched write work %p\n", m);
  538. queue_work(p9_mux_wq, &m->wq);
  539. }
  540. }
  541. }
  542. /**
  543. * p9_fd_request - send 9P request
  544. * The function can sleep until the request is scheduled for sending.
  545. * The function can be interrupted. Return from the function is not
  546. * a guarantee that the request is sent successfully.
  547. *
  548. * @client: client instance
  549. * @req: request to be sent
  550. *
  551. */
  552. static int p9_fd_request(struct p9_client *client, struct p9_req_t *req)
  553. {
  554. int n;
  555. struct p9_trans_fd *ts = client->trans;
  556. struct p9_conn *m = ts->conn;
  557. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p task %p tcall %p id %d\n", m,
  558. current, req->tc, req->tc->id);
  559. if (m->err < 0)
  560. return m->err;
  561. spin_lock(&client->lock);
  562. req->status = REQ_STATUS_UNSENT;
  563. list_add_tail(&req->req_list, &m->unsent_req_list);
  564. spin_unlock(&client->lock);
  565. if (test_and_clear_bit(Wpending, &m->wsched))
  566. n = POLLOUT;
  567. else
  568. n = p9_fd_poll(m->client, NULL);
  569. if (n & POLLOUT && !test_and_set_bit(Wworksched, &m->wsched))
  570. queue_work(p9_mux_wq, &m->wq);
  571. return 0;
  572. }
  573. static int p9_fd_cancel(struct p9_client *client, struct p9_req_t *req)
  574. {
  575. int ret = 1;
  576. P9_DPRINTK(P9_DEBUG_TRANS, "client %p req %p\n", client, req);
  577. spin_lock(&client->lock);
  578. if (req->status == REQ_STATUS_UNSENT) {
  579. list_del(&req->req_list);
  580. req->status = REQ_STATUS_FLSHD;
  581. ret = 0;
  582. } else if (req->status == REQ_STATUS_SENT)
  583. req->status = REQ_STATUS_FLSH;
  584. spin_unlock(&client->lock);
  585. return ret;
  586. }
  587. /**
  588. * parse_opts - parse mount options into p9_fd_opts structure
  589. * @params: options string passed from mount
  590. * @opts: fd transport-specific structure to parse options into
  591. *
  592. * Returns 0 upon success, -ERRNO upon failure
  593. */
  594. static int parse_opts(char *params, struct p9_fd_opts *opts)
  595. {
  596. char *p;
  597. substring_t args[MAX_OPT_ARGS];
  598. int option;
  599. char *options;
  600. int ret;
  601. opts->port = P9_PORT;
  602. opts->rfd = ~0;
  603. opts->wfd = ~0;
  604. if (!params)
  605. return 0;
  606. options = kstrdup(params, GFP_KERNEL);
  607. if (!options) {
  608. P9_DPRINTK(P9_DEBUG_ERROR,
  609. "failed to allocate copy of option string\n");
  610. return -ENOMEM;
  611. }
  612. while ((p = strsep(&options, ",")) != NULL) {
  613. int token;
  614. int r;
  615. if (!*p)
  616. continue;
  617. token = match_token(p, tokens, args);
  618. if (token != Opt_err) {
  619. r = match_int(&args[0], &option);
  620. if (r < 0) {
  621. P9_DPRINTK(P9_DEBUG_ERROR,
  622. "integer field, but no integer?\n");
  623. ret = r;
  624. continue;
  625. }
  626. }
  627. switch (token) {
  628. case Opt_port:
  629. opts->port = option;
  630. break;
  631. case Opt_rfdno:
  632. opts->rfd = option;
  633. break;
  634. case Opt_wfdno:
  635. opts->wfd = option;
  636. break;
  637. default:
  638. continue;
  639. }
  640. }
  641. kfree(options);
  642. return 0;
  643. }
  644. static int p9_fd_open(struct p9_client *client, int rfd, int wfd)
  645. {
  646. struct p9_trans_fd *ts = kmalloc(sizeof(struct p9_trans_fd),
  647. GFP_KERNEL);
  648. if (!ts)
  649. return -ENOMEM;
  650. ts->rd = fget(rfd);
  651. ts->wr = fget(wfd);
  652. if (!ts->rd || !ts->wr) {
  653. if (ts->rd)
  654. fput(ts->rd);
  655. if (ts->wr)
  656. fput(ts->wr);
  657. kfree(ts);
  658. return -EIO;
  659. }
  660. client->trans = ts;
  661. client->status = Connected;
  662. return 0;
  663. }
  664. static int p9_socket_open(struct p9_client *client, struct socket *csocket)
  665. {
  666. int fd, ret;
  667. csocket->sk->sk_allocation = GFP_NOIO;
  668. fd = sock_map_fd(csocket, 0);
  669. if (fd < 0) {
  670. P9_EPRINTK(KERN_ERR, "p9_socket_open: failed to map fd\n");
  671. return fd;
  672. }
  673. ret = p9_fd_open(client, fd, fd);
  674. if (ret < 0) {
  675. P9_EPRINTK(KERN_ERR, "p9_socket_open: failed to open fd\n");
  676. sockfd_put(csocket);
  677. return ret;
  678. }
  679. ((struct p9_trans_fd *)client->trans)->rd->f_flags |= O_NONBLOCK;
  680. return 0;
  681. }
  682. /**
  683. * p9_mux_destroy - cancels all pending requests and frees mux resources
  684. * @m: mux to destroy
  685. *
  686. */
  687. static void p9_conn_destroy(struct p9_conn *m)
  688. {
  689. P9_DPRINTK(P9_DEBUG_TRANS, "mux %p prev %p next %p\n", m,
  690. m->mux_list.prev, m->mux_list.next);
  691. p9_mux_poll_stop(m);
  692. cancel_work_sync(&m->rq);
  693. cancel_work_sync(&m->wq);
  694. p9_conn_cancel(m, -ECONNRESET);
  695. m->client = NULL;
  696. kfree(m);
  697. }
  698. /**
  699. * p9_fd_close - shutdown file descriptor transport
  700. * @client: client instance
  701. *
  702. */
  703. static void p9_fd_close(struct p9_client *client)
  704. {
  705. struct p9_trans_fd *ts;
  706. if (!client)
  707. return;
  708. ts = client->trans;
  709. if (!ts)
  710. return;
  711. client->status = Disconnected;
  712. p9_conn_destroy(ts->conn);
  713. if (ts->rd)
  714. fput(ts->rd);
  715. if (ts->wr)
  716. fput(ts->wr);
  717. kfree(ts);
  718. }
  719. /*
  720. * stolen from NFS - maybe should be made a generic function?
  721. */
  722. static inline int valid_ipaddr4(const char *buf)
  723. {
  724. int rc, count, in[4];
  725. rc = sscanf(buf, "%d.%d.%d.%d", &in[0], &in[1], &in[2], &in[3]);
  726. if (rc != 4)
  727. return -EINVAL;
  728. for (count = 0; count < 4; count++) {
  729. if (in[count] > 255)
  730. return -EINVAL;
  731. }
  732. return 0;
  733. }
  734. static int
  735. p9_fd_create_tcp(struct p9_client *client, const char *addr, char *args)
  736. {
  737. int err;
  738. struct socket *csocket;
  739. struct sockaddr_in sin_server;
  740. struct p9_fd_opts opts;
  741. struct p9_trans_fd *p = NULL; /* this gets allocated in p9_fd_open */
  742. err = parse_opts(args, &opts);
  743. if (err < 0)
  744. return err;
  745. if (valid_ipaddr4(addr) < 0)
  746. return -EINVAL;
  747. csocket = NULL;
  748. sin_server.sin_family = AF_INET;
  749. sin_server.sin_addr.s_addr = in_aton(addr);
  750. sin_server.sin_port = htons(opts.port);
  751. sock_create_kern(PF_INET, SOCK_STREAM, IPPROTO_TCP, &csocket);
  752. if (!csocket) {
  753. P9_EPRINTK(KERN_ERR, "p9_trans_tcp: problem creating socket\n");
  754. err = -EIO;
  755. goto error;
  756. }
  757. err = csocket->ops->connect(csocket,
  758. (struct sockaddr *)&sin_server,
  759. sizeof(struct sockaddr_in), 0);
  760. if (err < 0) {
  761. P9_EPRINTK(KERN_ERR,
  762. "p9_trans_tcp: problem connecting socket to %s\n",
  763. addr);
  764. goto error;
  765. }
  766. err = p9_socket_open(client, csocket);
  767. if (err < 0)
  768. goto error;
  769. p = (struct p9_trans_fd *) client->trans;
  770. p->conn = p9_conn_create(client);
  771. if (IS_ERR(p->conn)) {
  772. err = PTR_ERR(p->conn);
  773. p->conn = NULL;
  774. goto error;
  775. }
  776. return 0;
  777. error:
  778. if (csocket)
  779. sock_release(csocket);
  780. kfree(p);
  781. return err;
  782. }
  783. static int
  784. p9_fd_create_unix(struct p9_client *client, const char *addr, char *args)
  785. {
  786. int err;
  787. struct socket *csocket;
  788. struct sockaddr_un sun_server;
  789. struct p9_trans_fd *p = NULL; /* this gets allocated in p9_fd_open */
  790. csocket = NULL;
  791. if (strlen(addr) > UNIX_PATH_MAX) {
  792. P9_EPRINTK(KERN_ERR, "p9_trans_unix: address too long: %s\n",
  793. addr);
  794. err = -ENAMETOOLONG;
  795. goto error;
  796. }
  797. sun_server.sun_family = PF_UNIX;
  798. strcpy(sun_server.sun_path, addr);
  799. sock_create_kern(PF_UNIX, SOCK_STREAM, 0, &csocket);
  800. err = csocket->ops->connect(csocket, (struct sockaddr *)&sun_server,
  801. sizeof(struct sockaddr_un) - 1, 0);
  802. if (err < 0) {
  803. P9_EPRINTK(KERN_ERR,
  804. "p9_trans_unix: problem connecting socket: %s: %d\n",
  805. addr, err);
  806. goto error;
  807. }
  808. err = p9_socket_open(client, csocket);
  809. if (err < 0)
  810. goto error;
  811. p = (struct p9_trans_fd *) client->trans;
  812. p->conn = p9_conn_create(client);
  813. if (IS_ERR(p->conn)) {
  814. err = PTR_ERR(p->conn);
  815. p->conn = NULL;
  816. goto error;
  817. }
  818. return 0;
  819. error:
  820. if (csocket)
  821. sock_release(csocket);
  822. kfree(p);
  823. return err;
  824. }
  825. static int
  826. p9_fd_create(struct p9_client *client, const char *addr, char *args)
  827. {
  828. int err;
  829. struct p9_fd_opts opts;
  830. struct p9_trans_fd *p = NULL; /* this get allocated in p9_fd_open */
  831. parse_opts(args, &opts);
  832. if (opts.rfd == ~0 || opts.wfd == ~0) {
  833. printk(KERN_ERR "v9fs: Insufficient options for proto=fd\n");
  834. return -ENOPROTOOPT;
  835. }
  836. err = p9_fd_open(client, opts.rfd, opts.wfd);
  837. if (err < 0)
  838. goto error;
  839. p = (struct p9_trans_fd *) client->trans;
  840. p->conn = p9_conn_create(client);
  841. if (IS_ERR(p->conn)) {
  842. err = PTR_ERR(p->conn);
  843. p->conn = NULL;
  844. goto error;
  845. }
  846. return 0;
  847. error:
  848. kfree(p);
  849. return err;
  850. }
  851. static struct p9_trans_module p9_tcp_trans = {
  852. .name = "tcp",
  853. .maxsize = MAX_SOCK_BUF,
  854. .def = 1,
  855. .create = p9_fd_create_tcp,
  856. .close = p9_fd_close,
  857. .request = p9_fd_request,
  858. .cancel = p9_fd_cancel,
  859. .owner = THIS_MODULE,
  860. };
  861. static struct p9_trans_module p9_unix_trans = {
  862. .name = "unix",
  863. .maxsize = MAX_SOCK_BUF,
  864. .def = 0,
  865. .create = p9_fd_create_unix,
  866. .close = p9_fd_close,
  867. .request = p9_fd_request,
  868. .cancel = p9_fd_cancel,
  869. .owner = THIS_MODULE,
  870. };
  871. static struct p9_trans_module p9_fd_trans = {
  872. .name = "fd",
  873. .maxsize = MAX_SOCK_BUF,
  874. .def = 0,
  875. .create = p9_fd_create,
  876. .close = p9_fd_close,
  877. .request = p9_fd_request,
  878. .cancel = p9_fd_cancel,
  879. .owner = THIS_MODULE,
  880. };
  881. /**
  882. * p9_poll_proc - poll worker thread
  883. * @a: thread state and arguments
  884. *
  885. * polls all v9fs transports for new events and queues the appropriate
  886. * work to the work queue
  887. *
  888. */
  889. static int p9_poll_proc(void *a)
  890. {
  891. unsigned long flags;
  892. P9_DPRINTK(P9_DEBUG_TRANS, "start %p\n", current);
  893. repeat:
  894. spin_lock_irqsave(&p9_poll_lock, flags);
  895. while (!list_empty(&p9_poll_pending_list)) {
  896. struct p9_conn *conn = list_first_entry(&p9_poll_pending_list,
  897. struct p9_conn,
  898. poll_pending_link);
  899. list_del_init(&conn->poll_pending_link);
  900. spin_unlock_irqrestore(&p9_poll_lock, flags);
  901. p9_poll_mux(conn);
  902. spin_lock_irqsave(&p9_poll_lock, flags);
  903. }
  904. spin_unlock_irqrestore(&p9_poll_lock, flags);
  905. set_current_state(TASK_INTERRUPTIBLE);
  906. if (list_empty(&p9_poll_pending_list)) {
  907. P9_DPRINTK(P9_DEBUG_TRANS, "sleeping...\n");
  908. schedule();
  909. }
  910. __set_current_state(TASK_RUNNING);
  911. if (!kthread_should_stop())
  912. goto repeat;
  913. P9_DPRINTK(P9_DEBUG_TRANS, "finish\n");
  914. return 0;
  915. }
  916. int p9_trans_fd_init(void)
  917. {
  918. p9_mux_wq = create_workqueue("v9fs");
  919. if (!p9_mux_wq) {
  920. printk(KERN_WARNING "v9fs: mux: creating workqueue failed\n");
  921. return -ENOMEM;
  922. }
  923. p9_poll_task = kthread_run(p9_poll_proc, NULL, "v9fs-poll");
  924. if (IS_ERR(p9_poll_task)) {
  925. destroy_workqueue(p9_mux_wq);
  926. printk(KERN_WARNING "v9fs: mux: creating poll task failed\n");
  927. return PTR_ERR(p9_poll_task);
  928. }
  929. v9fs_register_trans(&p9_tcp_trans);
  930. v9fs_register_trans(&p9_unix_trans);
  931. v9fs_register_trans(&p9_fd_trans);
  932. return 0;
  933. }
  934. void p9_trans_fd_exit(void)
  935. {
  936. kthread_stop(p9_poll_task);
  937. v9fs_unregister_trans(&p9_tcp_trans);
  938. v9fs_unregister_trans(&p9_unix_trans);
  939. v9fs_unregister_trans(&p9_fd_trans);
  940. destroy_workqueue(p9_mux_wq);
  941. }