pep.c 29 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291
  1. /*
  2. * File: pep.c
  3. *
  4. * Phonet pipe protocol end point socket
  5. *
  6. * Copyright (C) 2008 Nokia Corporation.
  7. *
  8. * Author: Rémi Denis-Courmont <remi.denis-courmont@nokia.com>
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License
  12. * version 2 as published by the Free Software Foundation.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  22. * 02110-1301 USA
  23. */
  24. #include <linux/kernel.h>
  25. #include <linux/slab.h>
  26. #include <linux/socket.h>
  27. #include <net/sock.h>
  28. #include <net/tcp_states.h>
  29. #include <asm/ioctls.h>
  30. #include <linux/phonet.h>
  31. #include <linux/module.h>
  32. #include <net/phonet/phonet.h>
  33. #include <net/phonet/pep.h>
  34. #include <net/phonet/gprs.h>
  35. /* sk_state values:
  36. * TCP_CLOSE sock not in use yet
  37. * TCP_CLOSE_WAIT disconnected pipe
  38. * TCP_LISTEN listening pipe endpoint
  39. * TCP_SYN_RECV connected pipe in disabled state
  40. * TCP_ESTABLISHED connected pipe in enabled state
  41. *
  42. * pep_sock locking:
  43. * - sk_state, hlist: sock lock needed
  44. * - listener: read only
  45. * - pipe_handle: read only
  46. */
  47. #define CREDITS_MAX 10
  48. #define CREDITS_THR 7
  49. #define pep_sb_size(s) (((s) + 5) & ~3) /* 2-bytes head, 32-bits aligned */
  50. /* Get the next TLV sub-block. */
  51. static unsigned char *pep_get_sb(struct sk_buff *skb, u8 *ptype, u8 *plen,
  52. void *buf)
  53. {
  54. void *data = NULL;
  55. struct {
  56. u8 sb_type;
  57. u8 sb_len;
  58. } *ph, h;
  59. int buflen = *plen;
  60. ph = skb_header_pointer(skb, 0, 2, &h);
  61. if (ph == NULL || ph->sb_len < 2 || !pskb_may_pull(skb, ph->sb_len))
  62. return NULL;
  63. ph->sb_len -= 2;
  64. *ptype = ph->sb_type;
  65. *plen = ph->sb_len;
  66. if (buflen > ph->sb_len)
  67. buflen = ph->sb_len;
  68. data = skb_header_pointer(skb, 2, buflen, buf);
  69. __skb_pull(skb, 2 + ph->sb_len);
  70. return data;
  71. }
  72. static struct sk_buff *pep_alloc_skb(struct sock *sk, const void *payload,
  73. int len, gfp_t priority)
  74. {
  75. struct sk_buff *skb = alloc_skb(MAX_PNPIPE_HEADER + len, priority);
  76. if (!skb)
  77. return NULL;
  78. skb_set_owner_w(skb, sk);
  79. skb_reserve(skb, MAX_PNPIPE_HEADER);
  80. __skb_put(skb, len);
  81. skb_copy_to_linear_data(skb, payload, len);
  82. __skb_push(skb, sizeof(struct pnpipehdr));
  83. skb_reset_transport_header(skb);
  84. return skb;
  85. }
  86. static int pep_reply(struct sock *sk, struct sk_buff *oskb, u8 code,
  87. const void *data, int len, gfp_t priority)
  88. {
  89. const struct pnpipehdr *oph = pnp_hdr(oskb);
  90. struct pnpipehdr *ph;
  91. struct sk_buff *skb;
  92. struct sockaddr_pn peer;
  93. skb = pep_alloc_skb(sk, data, len, priority);
  94. if (!skb)
  95. return -ENOMEM;
  96. ph = pnp_hdr(skb);
  97. ph->utid = oph->utid;
  98. ph->message_id = oph->message_id + 1; /* REQ -> RESP */
  99. ph->pipe_handle = oph->pipe_handle;
  100. ph->error_code = code;
  101. pn_skb_get_src_sockaddr(oskb, &peer);
  102. return pn_skb_send(sk, skb, &peer);
  103. }
  104. static int pep_indicate(struct sock *sk, u8 id, u8 code,
  105. const void *data, int len, gfp_t priority)
  106. {
  107. struct pep_sock *pn = pep_sk(sk);
  108. struct pnpipehdr *ph;
  109. struct sk_buff *skb;
  110. skb = pep_alloc_skb(sk, data, len, priority);
  111. if (!skb)
  112. return -ENOMEM;
  113. ph = pnp_hdr(skb);
  114. ph->utid = 0;
  115. ph->message_id = id;
  116. ph->pipe_handle = pn->pipe_handle;
  117. ph->data[0] = code;
  118. return pn_skb_send(sk, skb, NULL);
  119. }
  120. #define PAD 0x00
  121. static int pipe_handler_request(struct sock *sk, u8 id, u8 code,
  122. const void *data, int len)
  123. {
  124. struct pep_sock *pn = pep_sk(sk);
  125. struct pnpipehdr *ph;
  126. struct sk_buff *skb;
  127. skb = pep_alloc_skb(sk, data, len, GFP_KERNEL);
  128. if (!skb)
  129. return -ENOMEM;
  130. ph = pnp_hdr(skb);
  131. ph->utid = id; /* whatever */
  132. ph->message_id = id;
  133. ph->pipe_handle = pn->pipe_handle;
  134. ph->data[0] = code;
  135. return pn_skb_send(sk, skb, NULL);
  136. }
  137. static int pipe_handler_send_created_ind(struct sock *sk)
  138. {
  139. struct pep_sock *pn = pep_sk(sk);
  140. u8 data[4] = {
  141. PN_PIPE_SB_NEGOTIATED_FC, pep_sb_size(2),
  142. pn->tx_fc, pn->rx_fc,
  143. };
  144. return pep_indicate(sk, PNS_PIPE_CREATED_IND, 1 /* sub-blocks */,
  145. data, 4, GFP_ATOMIC);
  146. }
  147. static int pep_accept_conn(struct sock *sk, struct sk_buff *skb)
  148. {
  149. static const u8 data[20] = {
  150. PAD, PAD, PAD, 2 /* sub-blocks */,
  151. PN_PIPE_SB_REQUIRED_FC_TX, pep_sb_size(5), 3, PAD,
  152. PN_MULTI_CREDIT_FLOW_CONTROL,
  153. PN_ONE_CREDIT_FLOW_CONTROL,
  154. PN_LEGACY_FLOW_CONTROL,
  155. PAD,
  156. PN_PIPE_SB_PREFERRED_FC_RX, pep_sb_size(5), 3, PAD,
  157. PN_MULTI_CREDIT_FLOW_CONTROL,
  158. PN_ONE_CREDIT_FLOW_CONTROL,
  159. PN_LEGACY_FLOW_CONTROL,
  160. PAD,
  161. };
  162. might_sleep();
  163. return pep_reply(sk, skb, PN_PIPE_NO_ERROR, data, sizeof(data),
  164. GFP_KERNEL);
  165. }
  166. static int pep_reject_conn(struct sock *sk, struct sk_buff *skb, u8 code,
  167. gfp_t priority)
  168. {
  169. static const u8 data[4] = { PAD, PAD, PAD, 0 /* sub-blocks */ };
  170. WARN_ON(code == PN_PIPE_NO_ERROR);
  171. return pep_reply(sk, skb, code, data, sizeof(data), priority);
  172. }
  173. /* Control requests are not sent by the pipe service and have a specific
  174. * message format. */
  175. static int pep_ctrlreq_error(struct sock *sk, struct sk_buff *oskb, u8 code,
  176. gfp_t priority)
  177. {
  178. const struct pnpipehdr *oph = pnp_hdr(oskb);
  179. struct sk_buff *skb;
  180. struct pnpipehdr *ph;
  181. struct sockaddr_pn dst;
  182. u8 data[4] = {
  183. oph->data[0], /* PEP type */
  184. code, /* error code, at an unusual offset */
  185. PAD, PAD,
  186. };
  187. skb = pep_alloc_skb(sk, data, 4, priority);
  188. if (!skb)
  189. return -ENOMEM;
  190. ph = pnp_hdr(skb);
  191. ph->utid = oph->utid;
  192. ph->message_id = PNS_PEP_CTRL_RESP;
  193. ph->pipe_handle = oph->pipe_handle;
  194. ph->data[0] = oph->data[1]; /* CTRL id */
  195. pn_skb_get_src_sockaddr(oskb, &dst);
  196. return pn_skb_send(sk, skb, &dst);
  197. }
  198. static int pipe_snd_status(struct sock *sk, u8 type, u8 status, gfp_t priority)
  199. {
  200. u8 data[4] = { type, PAD, PAD, status };
  201. return pep_indicate(sk, PNS_PEP_STATUS_IND, PN_PEP_TYPE_COMMON,
  202. data, 4, priority);
  203. }
  204. /* Send our RX flow control information to the sender.
  205. * Socket must be locked. */
  206. static void pipe_grant_credits(struct sock *sk, gfp_t priority)
  207. {
  208. struct pep_sock *pn = pep_sk(sk);
  209. BUG_ON(sk->sk_state != TCP_ESTABLISHED);
  210. switch (pn->rx_fc) {
  211. case PN_LEGACY_FLOW_CONTROL: /* TODO */
  212. break;
  213. case PN_ONE_CREDIT_FLOW_CONTROL:
  214. if (pipe_snd_status(sk, PN_PEP_IND_FLOW_CONTROL,
  215. PEP_IND_READY, priority) == 0)
  216. pn->rx_credits = 1;
  217. break;
  218. case PN_MULTI_CREDIT_FLOW_CONTROL:
  219. if ((pn->rx_credits + CREDITS_THR) > CREDITS_MAX)
  220. break;
  221. if (pipe_snd_status(sk, PN_PEP_IND_ID_MCFC_GRANT_CREDITS,
  222. CREDITS_MAX - pn->rx_credits,
  223. priority) == 0)
  224. pn->rx_credits = CREDITS_MAX;
  225. break;
  226. }
  227. }
  228. static int pipe_rcv_status(struct sock *sk, struct sk_buff *skb)
  229. {
  230. struct pep_sock *pn = pep_sk(sk);
  231. struct pnpipehdr *hdr;
  232. int wake = 0;
  233. if (!pskb_may_pull(skb, sizeof(*hdr) + 4))
  234. return -EINVAL;
  235. hdr = pnp_hdr(skb);
  236. if (hdr->data[0] != PN_PEP_TYPE_COMMON) {
  237. LIMIT_NETDEBUG(KERN_DEBUG"Phonet unknown PEP type: %u\n",
  238. (unsigned)hdr->data[0]);
  239. return -EOPNOTSUPP;
  240. }
  241. switch (hdr->data[1]) {
  242. case PN_PEP_IND_FLOW_CONTROL:
  243. switch (pn->tx_fc) {
  244. case PN_LEGACY_FLOW_CONTROL:
  245. switch (hdr->data[4]) {
  246. case PEP_IND_BUSY:
  247. atomic_set(&pn->tx_credits, 0);
  248. break;
  249. case PEP_IND_READY:
  250. atomic_set(&pn->tx_credits, wake = 1);
  251. break;
  252. }
  253. break;
  254. case PN_ONE_CREDIT_FLOW_CONTROL:
  255. if (hdr->data[4] == PEP_IND_READY)
  256. atomic_set(&pn->tx_credits, wake = 1);
  257. break;
  258. }
  259. break;
  260. case PN_PEP_IND_ID_MCFC_GRANT_CREDITS:
  261. if (pn->tx_fc != PN_MULTI_CREDIT_FLOW_CONTROL)
  262. break;
  263. atomic_add(wake = hdr->data[4], &pn->tx_credits);
  264. break;
  265. default:
  266. LIMIT_NETDEBUG(KERN_DEBUG"Phonet unknown PEP indication: %u\n",
  267. (unsigned)hdr->data[1]);
  268. return -EOPNOTSUPP;
  269. }
  270. if (wake)
  271. sk->sk_write_space(sk);
  272. return 0;
  273. }
  274. static int pipe_rcv_created(struct sock *sk, struct sk_buff *skb)
  275. {
  276. struct pep_sock *pn = pep_sk(sk);
  277. struct pnpipehdr *hdr = pnp_hdr(skb);
  278. u8 n_sb = hdr->data[0];
  279. pn->rx_fc = pn->tx_fc = PN_LEGACY_FLOW_CONTROL;
  280. __skb_pull(skb, sizeof(*hdr));
  281. while (n_sb > 0) {
  282. u8 type, buf[2], len = sizeof(buf);
  283. u8 *data = pep_get_sb(skb, &type, &len, buf);
  284. if (data == NULL)
  285. return -EINVAL;
  286. switch (type) {
  287. case PN_PIPE_SB_NEGOTIATED_FC:
  288. if (len < 2 || (data[0] | data[1]) > 3)
  289. break;
  290. pn->tx_fc = data[0] & 3;
  291. pn->rx_fc = data[1] & 3;
  292. break;
  293. }
  294. n_sb--;
  295. }
  296. return 0;
  297. }
  298. /* Queue an skb to a connected sock.
  299. * Socket lock must be held. */
  300. static int pipe_do_rcv(struct sock *sk, struct sk_buff *skb)
  301. {
  302. struct pep_sock *pn = pep_sk(sk);
  303. struct pnpipehdr *hdr = pnp_hdr(skb);
  304. struct sk_buff_head *queue;
  305. int err = 0;
  306. BUG_ON(sk->sk_state == TCP_CLOSE_WAIT);
  307. switch (hdr->message_id) {
  308. case PNS_PEP_CONNECT_REQ:
  309. pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE, GFP_ATOMIC);
  310. break;
  311. case PNS_PEP_DISCONNECT_REQ:
  312. pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
  313. sk->sk_state = TCP_CLOSE_WAIT;
  314. if (!sock_flag(sk, SOCK_DEAD))
  315. sk->sk_state_change(sk);
  316. break;
  317. case PNS_PEP_ENABLE_REQ:
  318. /* Wait for PNS_PIPE_(ENABLED|REDIRECTED)_IND */
  319. pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
  320. break;
  321. case PNS_PEP_RESET_REQ:
  322. switch (hdr->state_after_reset) {
  323. case PN_PIPE_DISABLE:
  324. pn->init_enable = 0;
  325. break;
  326. case PN_PIPE_ENABLE:
  327. pn->init_enable = 1;
  328. break;
  329. default: /* not allowed to send an error here!? */
  330. err = -EINVAL;
  331. goto out;
  332. }
  333. /* fall through */
  334. case PNS_PEP_DISABLE_REQ:
  335. atomic_set(&pn->tx_credits, 0);
  336. pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
  337. break;
  338. case PNS_PEP_CTRL_REQ:
  339. if (skb_queue_len(&pn->ctrlreq_queue) >= PNPIPE_CTRLREQ_MAX) {
  340. atomic_inc(&sk->sk_drops);
  341. break;
  342. }
  343. __skb_pull(skb, 4);
  344. queue = &pn->ctrlreq_queue;
  345. goto queue;
  346. case PNS_PIPE_ALIGNED_DATA:
  347. __skb_pull(skb, 1);
  348. /* fall through */
  349. case PNS_PIPE_DATA:
  350. __skb_pull(skb, 3); /* Pipe data header */
  351. if (!pn_flow_safe(pn->rx_fc)) {
  352. err = sock_queue_rcv_skb(sk, skb);
  353. if (!err)
  354. return NET_RX_SUCCESS;
  355. err = -ENOBUFS;
  356. break;
  357. }
  358. if (pn->rx_credits == 0) {
  359. atomic_inc(&sk->sk_drops);
  360. err = -ENOBUFS;
  361. break;
  362. }
  363. pn->rx_credits--;
  364. queue = &sk->sk_receive_queue;
  365. goto queue;
  366. case PNS_PEP_STATUS_IND:
  367. pipe_rcv_status(sk, skb);
  368. break;
  369. case PNS_PIPE_REDIRECTED_IND:
  370. err = pipe_rcv_created(sk, skb);
  371. break;
  372. case PNS_PIPE_CREATED_IND:
  373. err = pipe_rcv_created(sk, skb);
  374. if (err)
  375. break;
  376. /* fall through */
  377. case PNS_PIPE_RESET_IND:
  378. if (!pn->init_enable)
  379. break;
  380. /* fall through */
  381. case PNS_PIPE_ENABLED_IND:
  382. if (!pn_flow_safe(pn->tx_fc)) {
  383. atomic_set(&pn->tx_credits, 1);
  384. sk->sk_write_space(sk);
  385. }
  386. if (sk->sk_state == TCP_ESTABLISHED)
  387. break; /* Nothing to do */
  388. sk->sk_state = TCP_ESTABLISHED;
  389. pipe_grant_credits(sk, GFP_ATOMIC);
  390. break;
  391. case PNS_PIPE_DISABLED_IND:
  392. sk->sk_state = TCP_SYN_RECV;
  393. pn->rx_credits = 0;
  394. break;
  395. default:
  396. LIMIT_NETDEBUG(KERN_DEBUG"Phonet unknown PEP message: %u\n",
  397. hdr->message_id);
  398. err = -EINVAL;
  399. }
  400. out:
  401. kfree_skb(skb);
  402. return (err == -ENOBUFS) ? NET_RX_DROP : NET_RX_SUCCESS;
  403. queue:
  404. skb->dev = NULL;
  405. skb_set_owner_r(skb, sk);
  406. err = skb->len;
  407. skb_queue_tail(queue, skb);
  408. if (!sock_flag(sk, SOCK_DEAD))
  409. sk->sk_data_ready(sk, err);
  410. return NET_RX_SUCCESS;
  411. }
  412. /* Destroy connected sock. */
  413. static void pipe_destruct(struct sock *sk)
  414. {
  415. struct pep_sock *pn = pep_sk(sk);
  416. skb_queue_purge(&sk->sk_receive_queue);
  417. skb_queue_purge(&pn->ctrlreq_queue);
  418. }
  419. static u8 pipe_negotiate_fc(const u8 *fcs, unsigned n)
  420. {
  421. unsigned i;
  422. u8 final_fc = PN_NO_FLOW_CONTROL;
  423. for (i = 0; i < n; i++) {
  424. u8 fc = fcs[i];
  425. if (fc > final_fc && fc < PN_MAX_FLOW_CONTROL)
  426. final_fc = fc;
  427. }
  428. return final_fc;
  429. }
  430. static int pep_connresp_rcv(struct sock *sk, struct sk_buff *skb)
  431. {
  432. struct pep_sock *pn = pep_sk(sk);
  433. struct pnpipehdr *hdr;
  434. u8 n_sb;
  435. if (!pskb_pull(skb, sizeof(*hdr) + 4))
  436. return -EINVAL;
  437. hdr = pnp_hdr(skb);
  438. if (hdr->error_code != PN_PIPE_NO_ERROR)
  439. return -ECONNREFUSED;
  440. /* Parse sub-blocks */
  441. n_sb = hdr->data[4];
  442. while (n_sb > 0) {
  443. u8 type, buf[6], len = sizeof(buf);
  444. const u8 *data = pep_get_sb(skb, &type, &len, buf);
  445. if (data == NULL)
  446. return -EINVAL;
  447. switch (type) {
  448. case PN_PIPE_SB_REQUIRED_FC_TX:
  449. if (len < 2 || len < data[0])
  450. break;
  451. pn->tx_fc = pipe_negotiate_fc(data + 2, len - 2);
  452. break;
  453. case PN_PIPE_SB_PREFERRED_FC_RX:
  454. if (len < 2 || len < data[0])
  455. break;
  456. pn->rx_fc = pipe_negotiate_fc(data + 2, len - 2);
  457. break;
  458. }
  459. n_sb--;
  460. }
  461. return pipe_handler_send_created_ind(sk);
  462. }
  463. /* Queue an skb to an actively connected sock.
  464. * Socket lock must be held. */
  465. static int pipe_handler_do_rcv(struct sock *sk, struct sk_buff *skb)
  466. {
  467. struct pep_sock *pn = pep_sk(sk);
  468. struct pnpipehdr *hdr = pnp_hdr(skb);
  469. int err = NET_RX_SUCCESS;
  470. switch (hdr->message_id) {
  471. case PNS_PIPE_ALIGNED_DATA:
  472. __skb_pull(skb, 1);
  473. /* fall through */
  474. case PNS_PIPE_DATA:
  475. __skb_pull(skb, 3); /* Pipe data header */
  476. if (!pn_flow_safe(pn->rx_fc)) {
  477. err = sock_queue_rcv_skb(sk, skb);
  478. if (!err)
  479. return NET_RX_SUCCESS;
  480. err = NET_RX_DROP;
  481. break;
  482. }
  483. if (pn->rx_credits == 0) {
  484. atomic_inc(&sk->sk_drops);
  485. err = NET_RX_DROP;
  486. break;
  487. }
  488. pn->rx_credits--;
  489. skb->dev = NULL;
  490. skb_set_owner_r(skb, sk);
  491. err = skb->len;
  492. skb_queue_tail(&sk->sk_receive_queue, skb);
  493. if (!sock_flag(sk, SOCK_DEAD))
  494. sk->sk_data_ready(sk, err);
  495. return NET_RX_SUCCESS;
  496. case PNS_PEP_CONNECT_RESP:
  497. if (sk->sk_state != TCP_SYN_SENT)
  498. break;
  499. if (!sock_flag(sk, SOCK_DEAD))
  500. sk->sk_state_change(sk);
  501. if (pep_connresp_rcv(sk, skb)) {
  502. sk->sk_state = TCP_CLOSE_WAIT;
  503. break;
  504. }
  505. sk->sk_state = TCP_ESTABLISHED;
  506. if (!pn_flow_safe(pn->tx_fc)) {
  507. atomic_set(&pn->tx_credits, 1);
  508. sk->sk_write_space(sk);
  509. }
  510. pipe_grant_credits(sk, GFP_ATOMIC);
  511. break;
  512. case PNS_PEP_DISCONNECT_RESP:
  513. /* sock should already be dead, nothing to do */
  514. break;
  515. case PNS_PEP_STATUS_IND:
  516. pipe_rcv_status(sk, skb);
  517. break;
  518. }
  519. kfree_skb(skb);
  520. return err;
  521. }
  522. /* Listening sock must be locked */
  523. static struct sock *pep_find_pipe(const struct hlist_head *hlist,
  524. const struct sockaddr_pn *dst,
  525. u8 pipe_handle)
  526. {
  527. struct hlist_node *node;
  528. struct sock *sknode;
  529. u16 dobj = pn_sockaddr_get_object(dst);
  530. sk_for_each(sknode, node, hlist) {
  531. struct pep_sock *pnnode = pep_sk(sknode);
  532. /* Ports match, but addresses might not: */
  533. if (pnnode->pn_sk.sobject != dobj)
  534. continue;
  535. if (pnnode->pipe_handle != pipe_handle)
  536. continue;
  537. if (sknode->sk_state == TCP_CLOSE_WAIT)
  538. continue;
  539. sock_hold(sknode);
  540. return sknode;
  541. }
  542. return NULL;
  543. }
  544. /*
  545. * Deliver an skb to a listening sock.
  546. * Socket lock must be held.
  547. * We then queue the skb to the right connected sock (if any).
  548. */
  549. static int pep_do_rcv(struct sock *sk, struct sk_buff *skb)
  550. {
  551. struct pep_sock *pn = pep_sk(sk);
  552. struct sock *sknode;
  553. struct pnpipehdr *hdr;
  554. struct sockaddr_pn dst;
  555. u8 pipe_handle;
  556. if (!pskb_may_pull(skb, sizeof(*hdr)))
  557. goto drop;
  558. hdr = pnp_hdr(skb);
  559. pipe_handle = hdr->pipe_handle;
  560. if (pipe_handle == PN_PIPE_INVALID_HANDLE)
  561. goto drop;
  562. pn_skb_get_dst_sockaddr(skb, &dst);
  563. /* Look for an existing pipe handle */
  564. sknode = pep_find_pipe(&pn->hlist, &dst, pipe_handle);
  565. if (sknode)
  566. return sk_receive_skb(sknode, skb, 1);
  567. switch (hdr->message_id) {
  568. case PNS_PEP_CONNECT_REQ:
  569. if (sk->sk_state != TCP_LISTEN || sk_acceptq_is_full(sk)) {
  570. pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE,
  571. GFP_ATOMIC);
  572. break;
  573. }
  574. skb_queue_head(&sk->sk_receive_queue, skb);
  575. sk_acceptq_added(sk);
  576. if (!sock_flag(sk, SOCK_DEAD))
  577. sk->sk_data_ready(sk, 0);
  578. return NET_RX_SUCCESS;
  579. case PNS_PEP_DISCONNECT_REQ:
  580. pep_reply(sk, skb, PN_PIPE_NO_ERROR, NULL, 0, GFP_ATOMIC);
  581. break;
  582. case PNS_PEP_CTRL_REQ:
  583. pep_ctrlreq_error(sk, skb, PN_PIPE_INVALID_HANDLE, GFP_ATOMIC);
  584. break;
  585. case PNS_PEP_RESET_REQ:
  586. case PNS_PEP_ENABLE_REQ:
  587. case PNS_PEP_DISABLE_REQ:
  588. /* invalid handle is not even allowed here! */
  589. break;
  590. default:
  591. if ((1 << sk->sk_state)
  592. & ~(TCPF_CLOSE|TCPF_LISTEN|TCPF_CLOSE_WAIT))
  593. /* actively connected socket */
  594. return pipe_handler_do_rcv(sk, skb);
  595. }
  596. drop:
  597. kfree_skb(skb);
  598. return NET_RX_SUCCESS;
  599. }
  600. static int pipe_do_remove(struct sock *sk)
  601. {
  602. struct pep_sock *pn = pep_sk(sk);
  603. struct pnpipehdr *ph;
  604. struct sk_buff *skb;
  605. skb = pep_alloc_skb(sk, NULL, 0, GFP_KERNEL);
  606. if (!skb)
  607. return -ENOMEM;
  608. ph = pnp_hdr(skb);
  609. ph->utid = 0;
  610. ph->message_id = PNS_PIPE_REMOVE_REQ;
  611. ph->pipe_handle = pn->pipe_handle;
  612. ph->data[0] = PAD;
  613. return pn_skb_send(sk, skb, NULL);
  614. }
  615. /* associated socket ceases to exist */
  616. static void pep_sock_close(struct sock *sk, long timeout)
  617. {
  618. struct pep_sock *pn = pep_sk(sk);
  619. int ifindex = 0;
  620. sock_hold(sk); /* keep a reference after sk_common_release() */
  621. sk_common_release(sk);
  622. lock_sock(sk);
  623. if ((1 << sk->sk_state) & (TCPF_SYN_RECV|TCPF_ESTABLISHED)) {
  624. if (sk->sk_backlog_rcv == pipe_do_rcv)
  625. /* Forcefully remove dangling Phonet pipe */
  626. pipe_do_remove(sk);
  627. else
  628. pipe_handler_request(sk, PNS_PEP_DISCONNECT_REQ, PAD,
  629. NULL, 0);
  630. }
  631. sk->sk_state = TCP_CLOSE;
  632. ifindex = pn->ifindex;
  633. pn->ifindex = 0;
  634. release_sock(sk);
  635. if (ifindex)
  636. gprs_detach(sk);
  637. sock_put(sk);
  638. }
  639. static struct sock *pep_sock_accept(struct sock *sk, int flags, int *errp)
  640. {
  641. struct pep_sock *pn = pep_sk(sk), *newpn;
  642. struct sock *newsk = NULL;
  643. struct sk_buff *skb;
  644. struct pnpipehdr *hdr;
  645. struct sockaddr_pn dst, src;
  646. int err;
  647. u16 peer_type;
  648. u8 pipe_handle, enabled, n_sb;
  649. u8 aligned = 0;
  650. skb = skb_recv_datagram(sk, 0, flags & O_NONBLOCK, errp);
  651. if (!skb)
  652. return NULL;
  653. lock_sock(sk);
  654. if (sk->sk_state != TCP_LISTEN) {
  655. err = -EINVAL;
  656. goto drop;
  657. }
  658. sk_acceptq_removed(sk);
  659. err = -EPROTO;
  660. if (!pskb_may_pull(skb, sizeof(*hdr) + 4))
  661. goto drop;
  662. hdr = pnp_hdr(skb);
  663. pipe_handle = hdr->pipe_handle;
  664. switch (hdr->state_after_connect) {
  665. case PN_PIPE_DISABLE:
  666. enabled = 0;
  667. break;
  668. case PN_PIPE_ENABLE:
  669. enabled = 1;
  670. break;
  671. default:
  672. pep_reject_conn(sk, skb, PN_PIPE_ERR_INVALID_PARAM,
  673. GFP_KERNEL);
  674. goto drop;
  675. }
  676. peer_type = hdr->other_pep_type << 8;
  677. /* Parse sub-blocks (options) */
  678. n_sb = hdr->data[4];
  679. while (n_sb > 0) {
  680. u8 type, buf[1], len = sizeof(buf);
  681. const u8 *data = pep_get_sb(skb, &type, &len, buf);
  682. if (data == NULL)
  683. goto drop;
  684. switch (type) {
  685. case PN_PIPE_SB_CONNECT_REQ_PEP_SUB_TYPE:
  686. if (len < 1)
  687. goto drop;
  688. peer_type = (peer_type & 0xff00) | data[0];
  689. break;
  690. case PN_PIPE_SB_ALIGNED_DATA:
  691. aligned = data[0] != 0;
  692. break;
  693. }
  694. n_sb--;
  695. }
  696. /* Check for duplicate pipe handle */
  697. newsk = pep_find_pipe(&pn->hlist, &dst, pipe_handle);
  698. if (unlikely(newsk)) {
  699. __sock_put(newsk);
  700. newsk = NULL;
  701. pep_reject_conn(sk, skb, PN_PIPE_ERR_PEP_IN_USE, GFP_KERNEL);
  702. goto drop;
  703. }
  704. /* Create a new to-be-accepted sock */
  705. newsk = sk_alloc(sock_net(sk), PF_PHONET, GFP_KERNEL, sk->sk_prot);
  706. if (!newsk) {
  707. pep_reject_conn(sk, skb, PN_PIPE_ERR_OVERLOAD, GFP_KERNEL);
  708. err = -ENOBUFS;
  709. goto drop;
  710. }
  711. sock_init_data(NULL, newsk);
  712. newsk->sk_state = TCP_SYN_RECV;
  713. newsk->sk_backlog_rcv = pipe_do_rcv;
  714. newsk->sk_protocol = sk->sk_protocol;
  715. newsk->sk_destruct = pipe_destruct;
  716. newpn = pep_sk(newsk);
  717. pn_skb_get_dst_sockaddr(skb, &dst);
  718. pn_skb_get_src_sockaddr(skb, &src);
  719. newpn->pn_sk.sobject = pn_sockaddr_get_object(&dst);
  720. newpn->pn_sk.dobject = pn_sockaddr_get_object(&src);
  721. newpn->pn_sk.resource = pn_sockaddr_get_resource(&dst);
  722. sock_hold(sk);
  723. newpn->listener = sk;
  724. skb_queue_head_init(&newpn->ctrlreq_queue);
  725. newpn->pipe_handle = pipe_handle;
  726. atomic_set(&newpn->tx_credits, 0);
  727. newpn->ifindex = 0;
  728. newpn->peer_type = peer_type;
  729. newpn->rx_credits = 0;
  730. newpn->rx_fc = newpn->tx_fc = PN_LEGACY_FLOW_CONTROL;
  731. newpn->init_enable = enabled;
  732. newpn->aligned = aligned;
  733. err = pep_accept_conn(newsk, skb);
  734. if (err) {
  735. sock_put(newsk);
  736. newsk = NULL;
  737. goto drop;
  738. }
  739. sk_add_node(newsk, &pn->hlist);
  740. drop:
  741. release_sock(sk);
  742. kfree_skb(skb);
  743. *errp = err;
  744. return newsk;
  745. }
  746. static int pep_sock_connect(struct sock *sk, struct sockaddr *addr, int len)
  747. {
  748. struct pep_sock *pn = pep_sk(sk);
  749. int err;
  750. u8 data[4] = { 0 /* sub-blocks */, PAD, PAD, PAD };
  751. pn->pipe_handle = 1; /* anything but INVALID_HANDLE */
  752. err = pipe_handler_request(sk, PNS_PEP_CONNECT_REQ,
  753. PN_PIPE_ENABLE, data, 4);
  754. if (err) {
  755. pn->pipe_handle = PN_PIPE_INVALID_HANDLE;
  756. return err;
  757. }
  758. sk->sk_state = TCP_SYN_SENT;
  759. return 0;
  760. }
  761. static int pep_ioctl(struct sock *sk, int cmd, unsigned long arg)
  762. {
  763. struct pep_sock *pn = pep_sk(sk);
  764. int answ;
  765. switch (cmd) {
  766. case SIOCINQ:
  767. if (sk->sk_state == TCP_LISTEN)
  768. return -EINVAL;
  769. lock_sock(sk);
  770. if (sock_flag(sk, SOCK_URGINLINE) &&
  771. !skb_queue_empty(&pn->ctrlreq_queue))
  772. answ = skb_peek(&pn->ctrlreq_queue)->len;
  773. else if (!skb_queue_empty(&sk->sk_receive_queue))
  774. answ = skb_peek(&sk->sk_receive_queue)->len;
  775. else
  776. answ = 0;
  777. release_sock(sk);
  778. return put_user(answ, (int __user *)arg);
  779. }
  780. return -ENOIOCTLCMD;
  781. }
  782. static int pep_init(struct sock *sk)
  783. {
  784. struct pep_sock *pn = pep_sk(sk);
  785. sk->sk_destruct = pipe_destruct;
  786. INIT_HLIST_HEAD(&pn->hlist);
  787. pn->listener = NULL;
  788. skb_queue_head_init(&pn->ctrlreq_queue);
  789. atomic_set(&pn->tx_credits, 0);
  790. pn->ifindex = 0;
  791. pn->peer_type = 0;
  792. pn->pipe_handle = PN_PIPE_INVALID_HANDLE;
  793. pn->rx_credits = 0;
  794. pn->rx_fc = pn->tx_fc = PN_LEGACY_FLOW_CONTROL;
  795. pn->init_enable = 1;
  796. pn->aligned = 0;
  797. return 0;
  798. }
  799. static int pep_setsockopt(struct sock *sk, int level, int optname,
  800. char __user *optval, unsigned int optlen)
  801. {
  802. struct pep_sock *pn = pep_sk(sk);
  803. int val = 0, err = 0;
  804. if (level != SOL_PNPIPE)
  805. return -ENOPROTOOPT;
  806. if (optlen >= sizeof(int)) {
  807. if (get_user(val, (int __user *) optval))
  808. return -EFAULT;
  809. }
  810. lock_sock(sk);
  811. switch (optname) {
  812. case PNPIPE_ENCAP:
  813. if (val && val != PNPIPE_ENCAP_IP) {
  814. err = -EINVAL;
  815. break;
  816. }
  817. if (!pn->ifindex == !val)
  818. break; /* Nothing to do! */
  819. if (!capable(CAP_NET_ADMIN)) {
  820. err = -EPERM;
  821. break;
  822. }
  823. if (val) {
  824. release_sock(sk);
  825. err = gprs_attach(sk);
  826. if (err > 0) {
  827. pn->ifindex = err;
  828. err = 0;
  829. }
  830. } else {
  831. pn->ifindex = 0;
  832. release_sock(sk);
  833. gprs_detach(sk);
  834. err = 0;
  835. }
  836. goto out_norel;
  837. default:
  838. err = -ENOPROTOOPT;
  839. }
  840. release_sock(sk);
  841. out_norel:
  842. return err;
  843. }
  844. static int pep_getsockopt(struct sock *sk, int level, int optname,
  845. char __user *optval, int __user *optlen)
  846. {
  847. struct pep_sock *pn = pep_sk(sk);
  848. int len, val;
  849. if (level != SOL_PNPIPE)
  850. return -ENOPROTOOPT;
  851. if (get_user(len, optlen))
  852. return -EFAULT;
  853. switch (optname) {
  854. case PNPIPE_ENCAP:
  855. val = pn->ifindex ? PNPIPE_ENCAP_IP : PNPIPE_ENCAP_NONE;
  856. break;
  857. case PNPIPE_IFINDEX:
  858. val = pn->ifindex;
  859. break;
  860. case PNPIPE_HANDLE:
  861. val = pn->pipe_handle;
  862. if (val == PN_PIPE_INVALID_HANDLE)
  863. return -EINVAL;
  864. break;
  865. default:
  866. return -ENOPROTOOPT;
  867. }
  868. len = min_t(unsigned int, sizeof(int), len);
  869. if (put_user(len, optlen))
  870. return -EFAULT;
  871. if (put_user(val, (int __user *) optval))
  872. return -EFAULT;
  873. return 0;
  874. }
  875. static int pipe_skb_send(struct sock *sk, struct sk_buff *skb)
  876. {
  877. struct pep_sock *pn = pep_sk(sk);
  878. struct pnpipehdr *ph;
  879. int err;
  880. if (pn_flow_safe(pn->tx_fc) &&
  881. !atomic_add_unless(&pn->tx_credits, -1, 0)) {
  882. kfree_skb(skb);
  883. return -ENOBUFS;
  884. }
  885. skb_push(skb, 3 + pn->aligned);
  886. skb_reset_transport_header(skb);
  887. ph = pnp_hdr(skb);
  888. ph->utid = 0;
  889. if (pn->aligned) {
  890. ph->message_id = PNS_PIPE_ALIGNED_DATA;
  891. ph->data[0] = 0; /* padding */
  892. } else
  893. ph->message_id = PNS_PIPE_DATA;
  894. ph->pipe_handle = pn->pipe_handle;
  895. err = pn_skb_send(sk, skb, NULL);
  896. if (err && pn_flow_safe(pn->tx_fc))
  897. atomic_inc(&pn->tx_credits);
  898. return err;
  899. }
  900. static int pep_sendmsg(struct kiocb *iocb, struct sock *sk,
  901. struct msghdr *msg, size_t len)
  902. {
  903. struct pep_sock *pn = pep_sk(sk);
  904. struct sk_buff *skb;
  905. long timeo;
  906. int flags = msg->msg_flags;
  907. int err, done;
  908. if ((msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_NOSIGNAL|
  909. MSG_CMSG_COMPAT)) ||
  910. !(msg->msg_flags & MSG_EOR))
  911. return -EOPNOTSUPP;
  912. skb = sock_alloc_send_skb(sk, MAX_PNPIPE_HEADER + len,
  913. flags & MSG_DONTWAIT, &err);
  914. if (!skb)
  915. return err;
  916. skb_reserve(skb, MAX_PHONET_HEADER + 3 + pn->aligned);
  917. err = memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len);
  918. if (err < 0)
  919. goto outfree;
  920. lock_sock(sk);
  921. timeo = sock_sndtimeo(sk, flags & MSG_DONTWAIT);
  922. if ((1 << sk->sk_state) & (TCPF_LISTEN|TCPF_CLOSE)) {
  923. err = -ENOTCONN;
  924. goto out;
  925. }
  926. if (sk->sk_state != TCP_ESTABLISHED) {
  927. /* Wait until the pipe gets to enabled state */
  928. disabled:
  929. err = sk_stream_wait_connect(sk, &timeo);
  930. if (err)
  931. goto out;
  932. if (sk->sk_state == TCP_CLOSE_WAIT) {
  933. err = -ECONNRESET;
  934. goto out;
  935. }
  936. }
  937. BUG_ON(sk->sk_state != TCP_ESTABLISHED);
  938. /* Wait until flow control allows TX */
  939. done = atomic_read(&pn->tx_credits);
  940. while (!done) {
  941. DEFINE_WAIT(wait);
  942. if (!timeo) {
  943. err = -EAGAIN;
  944. goto out;
  945. }
  946. if (signal_pending(current)) {
  947. err = sock_intr_errno(timeo);
  948. goto out;
  949. }
  950. prepare_to_wait(sk_sleep(sk), &wait,
  951. TASK_INTERRUPTIBLE);
  952. done = sk_wait_event(sk, &timeo, atomic_read(&pn->tx_credits));
  953. finish_wait(sk_sleep(sk), &wait);
  954. if (sk->sk_state != TCP_ESTABLISHED)
  955. goto disabled;
  956. }
  957. err = pipe_skb_send(sk, skb);
  958. if (err >= 0)
  959. err = len; /* success! */
  960. skb = NULL;
  961. out:
  962. release_sock(sk);
  963. outfree:
  964. kfree_skb(skb);
  965. return err;
  966. }
  967. int pep_writeable(struct sock *sk)
  968. {
  969. struct pep_sock *pn = pep_sk(sk);
  970. return atomic_read(&pn->tx_credits);
  971. }
  972. int pep_write(struct sock *sk, struct sk_buff *skb)
  973. {
  974. struct sk_buff *rskb, *fs;
  975. int flen = 0;
  976. if (pep_sk(sk)->aligned)
  977. return pipe_skb_send(sk, skb);
  978. rskb = alloc_skb(MAX_PNPIPE_HEADER, GFP_ATOMIC);
  979. if (!rskb) {
  980. kfree_skb(skb);
  981. return -ENOMEM;
  982. }
  983. skb_shinfo(rskb)->frag_list = skb;
  984. rskb->len += skb->len;
  985. rskb->data_len += rskb->len;
  986. rskb->truesize += rskb->len;
  987. /* Avoid nested fragments */
  988. skb_walk_frags(skb, fs)
  989. flen += fs->len;
  990. skb->next = skb_shinfo(skb)->frag_list;
  991. skb_frag_list_init(skb);
  992. skb->len -= flen;
  993. skb->data_len -= flen;
  994. skb->truesize -= flen;
  995. skb_reserve(rskb, MAX_PHONET_HEADER + 3);
  996. return pipe_skb_send(sk, rskb);
  997. }
  998. struct sk_buff *pep_read(struct sock *sk)
  999. {
  1000. struct sk_buff *skb = skb_dequeue(&sk->sk_receive_queue);
  1001. if (sk->sk_state == TCP_ESTABLISHED)
  1002. pipe_grant_credits(sk, GFP_ATOMIC);
  1003. return skb;
  1004. }
  1005. static int pep_recvmsg(struct kiocb *iocb, struct sock *sk,
  1006. struct msghdr *msg, size_t len, int noblock,
  1007. int flags, int *addr_len)
  1008. {
  1009. struct sk_buff *skb;
  1010. int err;
  1011. if (flags & ~(MSG_OOB|MSG_PEEK|MSG_TRUNC|MSG_DONTWAIT|MSG_WAITALL|
  1012. MSG_NOSIGNAL|MSG_CMSG_COMPAT))
  1013. return -EOPNOTSUPP;
  1014. if (unlikely(1 << sk->sk_state & (TCPF_LISTEN | TCPF_CLOSE)))
  1015. return -ENOTCONN;
  1016. if ((flags & MSG_OOB) || sock_flag(sk, SOCK_URGINLINE)) {
  1017. /* Dequeue and acknowledge control request */
  1018. struct pep_sock *pn = pep_sk(sk);
  1019. if (flags & MSG_PEEK)
  1020. return -EOPNOTSUPP;
  1021. skb = skb_dequeue(&pn->ctrlreq_queue);
  1022. if (skb) {
  1023. pep_ctrlreq_error(sk, skb, PN_PIPE_NO_ERROR,
  1024. GFP_KERNEL);
  1025. msg->msg_flags |= MSG_OOB;
  1026. goto copy;
  1027. }
  1028. if (flags & MSG_OOB)
  1029. return -EINVAL;
  1030. }
  1031. skb = skb_recv_datagram(sk, flags, noblock, &err);
  1032. lock_sock(sk);
  1033. if (skb == NULL) {
  1034. if (err == -ENOTCONN && sk->sk_state == TCP_CLOSE_WAIT)
  1035. err = -ECONNRESET;
  1036. release_sock(sk);
  1037. return err;
  1038. }
  1039. if (sk->sk_state == TCP_ESTABLISHED)
  1040. pipe_grant_credits(sk, GFP_KERNEL);
  1041. release_sock(sk);
  1042. copy:
  1043. msg->msg_flags |= MSG_EOR;
  1044. if (skb->len > len)
  1045. msg->msg_flags |= MSG_TRUNC;
  1046. else
  1047. len = skb->len;
  1048. err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, len);
  1049. if (!err)
  1050. err = (flags & MSG_TRUNC) ? skb->len : len;
  1051. skb_free_datagram(sk, skb);
  1052. return err;
  1053. }
  1054. static void pep_sock_unhash(struct sock *sk)
  1055. {
  1056. struct pep_sock *pn = pep_sk(sk);
  1057. struct sock *skparent = NULL;
  1058. lock_sock(sk);
  1059. if (pn->listener != NULL) {
  1060. skparent = pn->listener;
  1061. pn->listener = NULL;
  1062. release_sock(sk);
  1063. pn = pep_sk(skparent);
  1064. lock_sock(skparent);
  1065. sk_del_node_init(sk);
  1066. sk = skparent;
  1067. }
  1068. /* Unhash a listening sock only when it is closed
  1069. * and all of its active connected pipes are closed. */
  1070. if (hlist_empty(&pn->hlist))
  1071. pn_sock_unhash(&pn->pn_sk.sk);
  1072. release_sock(sk);
  1073. if (skparent)
  1074. sock_put(skparent);
  1075. }
  1076. static struct proto pep_proto = {
  1077. .close = pep_sock_close,
  1078. .accept = pep_sock_accept,
  1079. .connect = pep_sock_connect,
  1080. .ioctl = pep_ioctl,
  1081. .init = pep_init,
  1082. .setsockopt = pep_setsockopt,
  1083. .getsockopt = pep_getsockopt,
  1084. .sendmsg = pep_sendmsg,
  1085. .recvmsg = pep_recvmsg,
  1086. .backlog_rcv = pep_do_rcv,
  1087. .hash = pn_sock_hash,
  1088. .unhash = pep_sock_unhash,
  1089. .get_port = pn_sock_get_port,
  1090. .obj_size = sizeof(struct pep_sock),
  1091. .owner = THIS_MODULE,
  1092. .name = "PNPIPE",
  1093. };
  1094. static struct phonet_protocol pep_pn_proto = {
  1095. .ops = &phonet_stream_ops,
  1096. .prot = &pep_proto,
  1097. .sock_type = SOCK_SEQPACKET,
  1098. };
  1099. static int __init pep_register(void)
  1100. {
  1101. return phonet_proto_register(PN_PROTO_PIPE, &pep_pn_proto);
  1102. }
  1103. static void __exit pep_unregister(void)
  1104. {
  1105. phonet_proto_unregister(PN_PROTO_PIPE, &pep_pn_proto);
  1106. }
  1107. module_init(pep_register);
  1108. module_exit(pep_unregister);
  1109. MODULE_AUTHOR("Remi Denis-Courmont, Nokia");
  1110. MODULE_DESCRIPTION("Phonet pipe protocol");
  1111. MODULE_LICENSE("GPL");
  1112. MODULE_ALIAS_NET_PF_PROTO(PF_PHONET, PN_PROTO_PIPE);