xfrm_user.c 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549
  1. /* xfrm_user.c: User interface to configure xfrm engine.
  2. *
  3. * Copyright (C) 2002 David S. Miller (davem@redhat.com)
  4. *
  5. * Changes:
  6. * Mitsuru KANDA @USAGI
  7. * Kazunori MIYAZAWA @USAGI
  8. * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
  9. * IPv6 support
  10. *
  11. */
  12. #include <linux/module.h>
  13. #include <linux/kernel.h>
  14. #include <linux/types.h>
  15. #include <linux/slab.h>
  16. #include <linux/socket.h>
  17. #include <linux/string.h>
  18. #include <linux/net.h>
  19. #include <linux/skbuff.h>
  20. #include <linux/netlink.h>
  21. #include <linux/rtnetlink.h>
  22. #include <linux/pfkeyv2.h>
  23. #include <linux/ipsec.h>
  24. #include <linux/init.h>
  25. #include <linux/security.h>
  26. #include <net/sock.h>
  27. #include <net/xfrm.h>
  28. #include <asm/uaccess.h>
  29. static struct sock *xfrm_nl;
  30. static int verify_one_alg(struct rtattr **xfrma, enum xfrm_attr_type_t type)
  31. {
  32. struct rtattr *rt = xfrma[type - 1];
  33. struct xfrm_algo *algp;
  34. int len;
  35. if (!rt)
  36. return 0;
  37. len = (rt->rta_len - sizeof(*rt)) - sizeof(*algp);
  38. if (len < 0)
  39. return -EINVAL;
  40. algp = RTA_DATA(rt);
  41. len -= (algp->alg_key_len + 7U) / 8;
  42. if (len < 0)
  43. return -EINVAL;
  44. switch (type) {
  45. case XFRMA_ALG_AUTH:
  46. if (!algp->alg_key_len &&
  47. strcmp(algp->alg_name, "digest_null") != 0)
  48. return -EINVAL;
  49. break;
  50. case XFRMA_ALG_CRYPT:
  51. if (!algp->alg_key_len &&
  52. strcmp(algp->alg_name, "cipher_null") != 0)
  53. return -EINVAL;
  54. break;
  55. case XFRMA_ALG_COMP:
  56. /* Zero length keys are legal. */
  57. break;
  58. default:
  59. return -EINVAL;
  60. };
  61. algp->alg_name[CRYPTO_MAX_ALG_NAME - 1] = '\0';
  62. return 0;
  63. }
  64. static int verify_encap_tmpl(struct rtattr **xfrma)
  65. {
  66. struct rtattr *rt = xfrma[XFRMA_ENCAP - 1];
  67. struct xfrm_encap_tmpl *encap;
  68. if (!rt)
  69. return 0;
  70. if ((rt->rta_len - sizeof(*rt)) < sizeof(*encap))
  71. return -EINVAL;
  72. return 0;
  73. }
  74. static int verify_newsa_info(struct xfrm_usersa_info *p,
  75. struct rtattr **xfrma)
  76. {
  77. int err;
  78. err = -EINVAL;
  79. switch (p->family) {
  80. case AF_INET:
  81. break;
  82. case AF_INET6:
  83. #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
  84. break;
  85. #else
  86. err = -EAFNOSUPPORT;
  87. goto out;
  88. #endif
  89. default:
  90. goto out;
  91. };
  92. err = -EINVAL;
  93. switch (p->id.proto) {
  94. case IPPROTO_AH:
  95. if (!xfrma[XFRMA_ALG_AUTH-1] ||
  96. xfrma[XFRMA_ALG_CRYPT-1] ||
  97. xfrma[XFRMA_ALG_COMP-1])
  98. goto out;
  99. break;
  100. case IPPROTO_ESP:
  101. if ((!xfrma[XFRMA_ALG_AUTH-1] &&
  102. !xfrma[XFRMA_ALG_CRYPT-1]) ||
  103. xfrma[XFRMA_ALG_COMP-1])
  104. goto out;
  105. break;
  106. case IPPROTO_COMP:
  107. if (!xfrma[XFRMA_ALG_COMP-1] ||
  108. xfrma[XFRMA_ALG_AUTH-1] ||
  109. xfrma[XFRMA_ALG_CRYPT-1])
  110. goto out;
  111. break;
  112. default:
  113. goto out;
  114. };
  115. if ((err = verify_one_alg(xfrma, XFRMA_ALG_AUTH)))
  116. goto out;
  117. if ((err = verify_one_alg(xfrma, XFRMA_ALG_CRYPT)))
  118. goto out;
  119. if ((err = verify_one_alg(xfrma, XFRMA_ALG_COMP)))
  120. goto out;
  121. if ((err = verify_encap_tmpl(xfrma)))
  122. goto out;
  123. err = -EINVAL;
  124. switch (p->mode) {
  125. case 0:
  126. case 1:
  127. break;
  128. default:
  129. goto out;
  130. };
  131. err = 0;
  132. out:
  133. return err;
  134. }
  135. static int attach_one_algo(struct xfrm_algo **algpp, u8 *props,
  136. struct xfrm_algo_desc *(*get_byname)(char *, int),
  137. struct rtattr *u_arg)
  138. {
  139. struct rtattr *rta = u_arg;
  140. struct xfrm_algo *p, *ualg;
  141. struct xfrm_algo_desc *algo;
  142. int len;
  143. if (!rta)
  144. return 0;
  145. ualg = RTA_DATA(rta);
  146. algo = get_byname(ualg->alg_name, 1);
  147. if (!algo)
  148. return -ENOSYS;
  149. *props = algo->desc.sadb_alg_id;
  150. len = sizeof(*ualg) + (ualg->alg_key_len + 7U) / 8;
  151. p = kmalloc(len, GFP_KERNEL);
  152. if (!p)
  153. return -ENOMEM;
  154. memcpy(p, ualg, len);
  155. *algpp = p;
  156. return 0;
  157. }
  158. static int attach_encap_tmpl(struct xfrm_encap_tmpl **encapp, struct rtattr *u_arg)
  159. {
  160. struct rtattr *rta = u_arg;
  161. struct xfrm_encap_tmpl *p, *uencap;
  162. if (!rta)
  163. return 0;
  164. uencap = RTA_DATA(rta);
  165. p = kmalloc(sizeof(*p), GFP_KERNEL);
  166. if (!p)
  167. return -ENOMEM;
  168. memcpy(p, uencap, sizeof(*p));
  169. *encapp = p;
  170. return 0;
  171. }
  172. static void copy_from_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
  173. {
  174. memcpy(&x->id, &p->id, sizeof(x->id));
  175. memcpy(&x->sel, &p->sel, sizeof(x->sel));
  176. memcpy(&x->lft, &p->lft, sizeof(x->lft));
  177. x->props.mode = p->mode;
  178. x->props.replay_window = p->replay_window;
  179. x->props.reqid = p->reqid;
  180. x->props.family = p->family;
  181. x->props.saddr = p->saddr;
  182. x->props.flags = p->flags;
  183. }
  184. static struct xfrm_state *xfrm_state_construct(struct xfrm_usersa_info *p,
  185. struct rtattr **xfrma,
  186. int *errp)
  187. {
  188. struct xfrm_state *x = xfrm_state_alloc();
  189. int err = -ENOMEM;
  190. if (!x)
  191. goto error_no_put;
  192. copy_from_user_state(x, p);
  193. if ((err = attach_one_algo(&x->aalg, &x->props.aalgo,
  194. xfrm_aalg_get_byname,
  195. xfrma[XFRMA_ALG_AUTH-1])))
  196. goto error;
  197. if ((err = attach_one_algo(&x->ealg, &x->props.ealgo,
  198. xfrm_ealg_get_byname,
  199. xfrma[XFRMA_ALG_CRYPT-1])))
  200. goto error;
  201. if ((err = attach_one_algo(&x->calg, &x->props.calgo,
  202. xfrm_calg_get_byname,
  203. xfrma[XFRMA_ALG_COMP-1])))
  204. goto error;
  205. if ((err = attach_encap_tmpl(&x->encap, xfrma[XFRMA_ENCAP-1])))
  206. goto error;
  207. err = xfrm_init_state(x);
  208. if (err)
  209. goto error;
  210. x->km.seq = p->seq;
  211. return x;
  212. error:
  213. x->km.state = XFRM_STATE_DEAD;
  214. xfrm_state_put(x);
  215. error_no_put:
  216. *errp = err;
  217. return NULL;
  218. }
  219. static int xfrm_add_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  220. {
  221. struct xfrm_usersa_info *p = NLMSG_DATA(nlh);
  222. struct xfrm_state *x;
  223. int err;
  224. struct km_event c;
  225. err = verify_newsa_info(p, (struct rtattr **) xfrma);
  226. if (err)
  227. return err;
  228. x = xfrm_state_construct(p, (struct rtattr **) xfrma, &err);
  229. if (!x)
  230. return err;
  231. xfrm_state_hold(x);
  232. if (nlh->nlmsg_type == XFRM_MSG_NEWSA)
  233. err = xfrm_state_add(x);
  234. else
  235. err = xfrm_state_update(x);
  236. if (err < 0) {
  237. x->km.state = XFRM_STATE_DEAD;
  238. xfrm_state_put(x);
  239. goto out;
  240. }
  241. c.seq = nlh->nlmsg_seq;
  242. c.pid = nlh->nlmsg_pid;
  243. c.event = nlh->nlmsg_type;
  244. km_state_notify(x, &c);
  245. out:
  246. xfrm_state_put(x);
  247. return err;
  248. }
  249. static int xfrm_del_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  250. {
  251. struct xfrm_state *x;
  252. int err;
  253. struct km_event c;
  254. struct xfrm_usersa_id *p = NLMSG_DATA(nlh);
  255. x = xfrm_state_lookup(&p->daddr, p->spi, p->proto, p->family);
  256. if (x == NULL)
  257. return -ESRCH;
  258. if (xfrm_state_kern(x)) {
  259. xfrm_state_put(x);
  260. return -EPERM;
  261. }
  262. err = xfrm_state_delete(x);
  263. if (err < 0) {
  264. xfrm_state_put(x);
  265. return err;
  266. }
  267. c.seq = nlh->nlmsg_seq;
  268. c.pid = nlh->nlmsg_pid;
  269. c.event = nlh->nlmsg_type;
  270. km_state_notify(x, &c);
  271. xfrm_state_put(x);
  272. return err;
  273. }
  274. static void copy_to_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
  275. {
  276. memcpy(&p->id, &x->id, sizeof(p->id));
  277. memcpy(&p->sel, &x->sel, sizeof(p->sel));
  278. memcpy(&p->lft, &x->lft, sizeof(p->lft));
  279. memcpy(&p->curlft, &x->curlft, sizeof(p->curlft));
  280. memcpy(&p->stats, &x->stats, sizeof(p->stats));
  281. p->saddr = x->props.saddr;
  282. p->mode = x->props.mode;
  283. p->replay_window = x->props.replay_window;
  284. p->reqid = x->props.reqid;
  285. p->family = x->props.family;
  286. p->flags = x->props.flags;
  287. p->seq = x->km.seq;
  288. }
  289. struct xfrm_dump_info {
  290. struct sk_buff *in_skb;
  291. struct sk_buff *out_skb;
  292. u32 nlmsg_seq;
  293. u16 nlmsg_flags;
  294. int start_idx;
  295. int this_idx;
  296. };
  297. static int dump_one_state(struct xfrm_state *x, int count, void *ptr)
  298. {
  299. struct xfrm_dump_info *sp = ptr;
  300. struct sk_buff *in_skb = sp->in_skb;
  301. struct sk_buff *skb = sp->out_skb;
  302. struct xfrm_usersa_info *p;
  303. struct nlmsghdr *nlh;
  304. unsigned char *b = skb->tail;
  305. if (sp->this_idx < sp->start_idx)
  306. goto out;
  307. nlh = NLMSG_PUT(skb, NETLINK_CB(in_skb).pid,
  308. sp->nlmsg_seq,
  309. XFRM_MSG_NEWSA, sizeof(*p));
  310. nlh->nlmsg_flags = sp->nlmsg_flags;
  311. p = NLMSG_DATA(nlh);
  312. copy_to_user_state(x, p);
  313. if (x->aalg)
  314. RTA_PUT(skb, XFRMA_ALG_AUTH,
  315. sizeof(*(x->aalg))+(x->aalg->alg_key_len+7)/8, x->aalg);
  316. if (x->ealg)
  317. RTA_PUT(skb, XFRMA_ALG_CRYPT,
  318. sizeof(*(x->ealg))+(x->ealg->alg_key_len+7)/8, x->ealg);
  319. if (x->calg)
  320. RTA_PUT(skb, XFRMA_ALG_COMP, sizeof(*(x->calg)), x->calg);
  321. if (x->encap)
  322. RTA_PUT(skb, XFRMA_ENCAP, sizeof(*x->encap), x->encap);
  323. nlh->nlmsg_len = skb->tail - b;
  324. out:
  325. sp->this_idx++;
  326. return 0;
  327. nlmsg_failure:
  328. rtattr_failure:
  329. skb_trim(skb, b - skb->data);
  330. return -1;
  331. }
  332. static int xfrm_dump_sa(struct sk_buff *skb, struct netlink_callback *cb)
  333. {
  334. struct xfrm_dump_info info;
  335. info.in_skb = cb->skb;
  336. info.out_skb = skb;
  337. info.nlmsg_seq = cb->nlh->nlmsg_seq;
  338. info.nlmsg_flags = NLM_F_MULTI;
  339. info.this_idx = 0;
  340. info.start_idx = cb->args[0];
  341. (void) xfrm_state_walk(IPSEC_PROTO_ANY, dump_one_state, &info);
  342. cb->args[0] = info.this_idx;
  343. return skb->len;
  344. }
  345. static struct sk_buff *xfrm_state_netlink(struct sk_buff *in_skb,
  346. struct xfrm_state *x, u32 seq)
  347. {
  348. struct xfrm_dump_info info;
  349. struct sk_buff *skb;
  350. skb = alloc_skb(NLMSG_GOODSIZE, GFP_ATOMIC);
  351. if (!skb)
  352. return ERR_PTR(-ENOMEM);
  353. NETLINK_CB(skb).dst_pid = NETLINK_CB(in_skb).pid;
  354. info.in_skb = in_skb;
  355. info.out_skb = skb;
  356. info.nlmsg_seq = seq;
  357. info.nlmsg_flags = 0;
  358. info.this_idx = info.start_idx = 0;
  359. if (dump_one_state(x, 0, &info)) {
  360. kfree_skb(skb);
  361. return NULL;
  362. }
  363. return skb;
  364. }
  365. static int xfrm_get_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  366. {
  367. struct xfrm_usersa_id *p = NLMSG_DATA(nlh);
  368. struct xfrm_state *x;
  369. struct sk_buff *resp_skb;
  370. int err;
  371. x = xfrm_state_lookup(&p->daddr, p->spi, p->proto, p->family);
  372. err = -ESRCH;
  373. if (x == NULL)
  374. goto out_noput;
  375. resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
  376. if (IS_ERR(resp_skb)) {
  377. err = PTR_ERR(resp_skb);
  378. } else {
  379. err = netlink_unicast(xfrm_nl, resp_skb,
  380. NETLINK_CB(skb).pid, MSG_DONTWAIT);
  381. }
  382. xfrm_state_put(x);
  383. out_noput:
  384. return err;
  385. }
  386. static int verify_userspi_info(struct xfrm_userspi_info *p)
  387. {
  388. switch (p->info.id.proto) {
  389. case IPPROTO_AH:
  390. case IPPROTO_ESP:
  391. break;
  392. case IPPROTO_COMP:
  393. /* IPCOMP spi is 16-bits. */
  394. if (p->max >= 0x10000)
  395. return -EINVAL;
  396. break;
  397. default:
  398. return -EINVAL;
  399. };
  400. if (p->min > p->max)
  401. return -EINVAL;
  402. return 0;
  403. }
  404. static int xfrm_alloc_userspi(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  405. {
  406. struct xfrm_state *x;
  407. struct xfrm_userspi_info *p;
  408. struct sk_buff *resp_skb;
  409. xfrm_address_t *daddr;
  410. int family;
  411. int err;
  412. p = NLMSG_DATA(nlh);
  413. err = verify_userspi_info(p);
  414. if (err)
  415. goto out_noput;
  416. family = p->info.family;
  417. daddr = &p->info.id.daddr;
  418. x = NULL;
  419. if (p->info.seq) {
  420. x = xfrm_find_acq_byseq(p->info.seq);
  421. if (x && xfrm_addr_cmp(&x->id.daddr, daddr, family)) {
  422. xfrm_state_put(x);
  423. x = NULL;
  424. }
  425. }
  426. if (!x)
  427. x = xfrm_find_acq(p->info.mode, p->info.reqid,
  428. p->info.id.proto, daddr,
  429. &p->info.saddr, 1,
  430. family);
  431. err = -ENOENT;
  432. if (x == NULL)
  433. goto out_noput;
  434. resp_skb = ERR_PTR(-ENOENT);
  435. spin_lock_bh(&x->lock);
  436. if (x->km.state != XFRM_STATE_DEAD) {
  437. xfrm_alloc_spi(x, htonl(p->min), htonl(p->max));
  438. if (x->id.spi)
  439. resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
  440. }
  441. spin_unlock_bh(&x->lock);
  442. if (IS_ERR(resp_skb)) {
  443. err = PTR_ERR(resp_skb);
  444. goto out;
  445. }
  446. err = netlink_unicast(xfrm_nl, resp_skb,
  447. NETLINK_CB(skb).pid, MSG_DONTWAIT);
  448. out:
  449. xfrm_state_put(x);
  450. out_noput:
  451. return err;
  452. }
  453. static int verify_policy_dir(__u8 dir)
  454. {
  455. switch (dir) {
  456. case XFRM_POLICY_IN:
  457. case XFRM_POLICY_OUT:
  458. case XFRM_POLICY_FWD:
  459. break;
  460. default:
  461. return -EINVAL;
  462. };
  463. return 0;
  464. }
  465. static int verify_newpolicy_info(struct xfrm_userpolicy_info *p)
  466. {
  467. switch (p->share) {
  468. case XFRM_SHARE_ANY:
  469. case XFRM_SHARE_SESSION:
  470. case XFRM_SHARE_USER:
  471. case XFRM_SHARE_UNIQUE:
  472. break;
  473. default:
  474. return -EINVAL;
  475. };
  476. switch (p->action) {
  477. case XFRM_POLICY_ALLOW:
  478. case XFRM_POLICY_BLOCK:
  479. break;
  480. default:
  481. return -EINVAL;
  482. };
  483. switch (p->sel.family) {
  484. case AF_INET:
  485. break;
  486. case AF_INET6:
  487. #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
  488. break;
  489. #else
  490. return -EAFNOSUPPORT;
  491. #endif
  492. default:
  493. return -EINVAL;
  494. };
  495. return verify_policy_dir(p->dir);
  496. }
  497. static void copy_templates(struct xfrm_policy *xp, struct xfrm_user_tmpl *ut,
  498. int nr)
  499. {
  500. int i;
  501. xp->xfrm_nr = nr;
  502. for (i = 0; i < nr; i++, ut++) {
  503. struct xfrm_tmpl *t = &xp->xfrm_vec[i];
  504. memcpy(&t->id, &ut->id, sizeof(struct xfrm_id));
  505. memcpy(&t->saddr, &ut->saddr,
  506. sizeof(xfrm_address_t));
  507. t->reqid = ut->reqid;
  508. t->mode = ut->mode;
  509. t->share = ut->share;
  510. t->optional = ut->optional;
  511. t->aalgos = ut->aalgos;
  512. t->ealgos = ut->ealgos;
  513. t->calgos = ut->calgos;
  514. }
  515. }
  516. static int copy_from_user_tmpl(struct xfrm_policy *pol, struct rtattr **xfrma)
  517. {
  518. struct rtattr *rt = xfrma[XFRMA_TMPL-1];
  519. struct xfrm_user_tmpl *utmpl;
  520. int nr;
  521. if (!rt) {
  522. pol->xfrm_nr = 0;
  523. } else {
  524. nr = (rt->rta_len - sizeof(*rt)) / sizeof(*utmpl);
  525. if (nr > XFRM_MAX_DEPTH)
  526. return -EINVAL;
  527. copy_templates(pol, RTA_DATA(rt), nr);
  528. }
  529. return 0;
  530. }
  531. static void copy_from_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p)
  532. {
  533. xp->priority = p->priority;
  534. xp->index = p->index;
  535. memcpy(&xp->selector, &p->sel, sizeof(xp->selector));
  536. memcpy(&xp->lft, &p->lft, sizeof(xp->lft));
  537. xp->action = p->action;
  538. xp->flags = p->flags;
  539. xp->family = p->sel.family;
  540. /* XXX xp->share = p->share; */
  541. }
  542. static void copy_to_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p, int dir)
  543. {
  544. memcpy(&p->sel, &xp->selector, sizeof(p->sel));
  545. memcpy(&p->lft, &xp->lft, sizeof(p->lft));
  546. memcpy(&p->curlft, &xp->curlft, sizeof(p->curlft));
  547. p->priority = xp->priority;
  548. p->index = xp->index;
  549. p->sel.family = xp->family;
  550. p->dir = dir;
  551. p->action = xp->action;
  552. p->flags = xp->flags;
  553. p->share = XFRM_SHARE_ANY; /* XXX xp->share */
  554. }
  555. static struct xfrm_policy *xfrm_policy_construct(struct xfrm_userpolicy_info *p, struct rtattr **xfrma, int *errp)
  556. {
  557. struct xfrm_policy *xp = xfrm_policy_alloc(GFP_KERNEL);
  558. int err;
  559. if (!xp) {
  560. *errp = -ENOMEM;
  561. return NULL;
  562. }
  563. copy_from_user_policy(xp, p);
  564. err = copy_from_user_tmpl(xp, xfrma);
  565. if (err) {
  566. *errp = err;
  567. kfree(xp);
  568. xp = NULL;
  569. }
  570. return xp;
  571. }
  572. static int xfrm_add_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  573. {
  574. struct xfrm_userpolicy_info *p = NLMSG_DATA(nlh);
  575. struct xfrm_policy *xp;
  576. struct km_event c;
  577. int err;
  578. int excl;
  579. err = verify_newpolicy_info(p);
  580. if (err)
  581. return err;
  582. xp = xfrm_policy_construct(p, (struct rtattr **) xfrma, &err);
  583. if (!xp)
  584. return err;
  585. /* shouldnt excl be based on nlh flags??
  586. * Aha! this is anti-netlink really i.e more pfkey derived
  587. * in netlink excl is a flag and you wouldnt need
  588. * a type XFRM_MSG_UPDPOLICY - JHS */
  589. excl = nlh->nlmsg_type == XFRM_MSG_NEWPOLICY;
  590. err = xfrm_policy_insert(p->dir, xp, excl);
  591. if (err) {
  592. kfree(xp);
  593. return err;
  594. }
  595. c.event = nlh->nlmsg_type;
  596. c.seq = nlh->nlmsg_seq;
  597. c.pid = nlh->nlmsg_pid;
  598. km_policy_notify(xp, p->dir, &c);
  599. xfrm_pol_put(xp);
  600. return 0;
  601. }
  602. static int copy_to_user_tmpl(struct xfrm_policy *xp, struct sk_buff *skb)
  603. {
  604. struct xfrm_user_tmpl vec[XFRM_MAX_DEPTH];
  605. int i;
  606. if (xp->xfrm_nr == 0)
  607. return 0;
  608. for (i = 0; i < xp->xfrm_nr; i++) {
  609. struct xfrm_user_tmpl *up = &vec[i];
  610. struct xfrm_tmpl *kp = &xp->xfrm_vec[i];
  611. memcpy(&up->id, &kp->id, sizeof(up->id));
  612. up->family = xp->family;
  613. memcpy(&up->saddr, &kp->saddr, sizeof(up->saddr));
  614. up->reqid = kp->reqid;
  615. up->mode = kp->mode;
  616. up->share = kp->share;
  617. up->optional = kp->optional;
  618. up->aalgos = kp->aalgos;
  619. up->ealgos = kp->ealgos;
  620. up->calgos = kp->calgos;
  621. }
  622. RTA_PUT(skb, XFRMA_TMPL,
  623. (sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr),
  624. vec);
  625. return 0;
  626. rtattr_failure:
  627. return -1;
  628. }
  629. static int dump_one_policy(struct xfrm_policy *xp, int dir, int count, void *ptr)
  630. {
  631. struct xfrm_dump_info *sp = ptr;
  632. struct xfrm_userpolicy_info *p;
  633. struct sk_buff *in_skb = sp->in_skb;
  634. struct sk_buff *skb = sp->out_skb;
  635. struct nlmsghdr *nlh;
  636. unsigned char *b = skb->tail;
  637. if (sp->this_idx < sp->start_idx)
  638. goto out;
  639. nlh = NLMSG_PUT(skb, NETLINK_CB(in_skb).pid,
  640. sp->nlmsg_seq,
  641. XFRM_MSG_NEWPOLICY, sizeof(*p));
  642. p = NLMSG_DATA(nlh);
  643. nlh->nlmsg_flags = sp->nlmsg_flags;
  644. copy_to_user_policy(xp, p, dir);
  645. if (copy_to_user_tmpl(xp, skb) < 0)
  646. goto nlmsg_failure;
  647. nlh->nlmsg_len = skb->tail - b;
  648. out:
  649. sp->this_idx++;
  650. return 0;
  651. nlmsg_failure:
  652. skb_trim(skb, b - skb->data);
  653. return -1;
  654. }
  655. static int xfrm_dump_policy(struct sk_buff *skb, struct netlink_callback *cb)
  656. {
  657. struct xfrm_dump_info info;
  658. info.in_skb = cb->skb;
  659. info.out_skb = skb;
  660. info.nlmsg_seq = cb->nlh->nlmsg_seq;
  661. info.nlmsg_flags = NLM_F_MULTI;
  662. info.this_idx = 0;
  663. info.start_idx = cb->args[0];
  664. (void) xfrm_policy_walk(dump_one_policy, &info);
  665. cb->args[0] = info.this_idx;
  666. return skb->len;
  667. }
  668. static struct sk_buff *xfrm_policy_netlink(struct sk_buff *in_skb,
  669. struct xfrm_policy *xp,
  670. int dir, u32 seq)
  671. {
  672. struct xfrm_dump_info info;
  673. struct sk_buff *skb;
  674. skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
  675. if (!skb)
  676. return ERR_PTR(-ENOMEM);
  677. NETLINK_CB(skb).dst_pid = NETLINK_CB(in_skb).pid;
  678. info.in_skb = in_skb;
  679. info.out_skb = skb;
  680. info.nlmsg_seq = seq;
  681. info.nlmsg_flags = 0;
  682. info.this_idx = info.start_idx = 0;
  683. if (dump_one_policy(xp, dir, 0, &info) < 0) {
  684. kfree_skb(skb);
  685. return NULL;
  686. }
  687. return skb;
  688. }
  689. static int xfrm_get_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  690. {
  691. struct xfrm_policy *xp;
  692. struct xfrm_userpolicy_id *p;
  693. int err;
  694. struct km_event c;
  695. int delete;
  696. p = NLMSG_DATA(nlh);
  697. delete = nlh->nlmsg_type == XFRM_MSG_DELPOLICY;
  698. err = verify_policy_dir(p->dir);
  699. if (err)
  700. return err;
  701. if (p->index)
  702. xp = xfrm_policy_byid(p->dir, p->index, delete);
  703. else
  704. xp = xfrm_policy_bysel(p->dir, &p->sel, delete);
  705. if (xp == NULL)
  706. return -ENOENT;
  707. if (!delete) {
  708. struct sk_buff *resp_skb;
  709. resp_skb = xfrm_policy_netlink(skb, xp, p->dir, nlh->nlmsg_seq);
  710. if (IS_ERR(resp_skb)) {
  711. err = PTR_ERR(resp_skb);
  712. } else {
  713. err = netlink_unicast(xfrm_nl, resp_skb,
  714. NETLINK_CB(skb).pid,
  715. MSG_DONTWAIT);
  716. }
  717. } else {
  718. c.data.byid = p->index;
  719. c.event = nlh->nlmsg_type;
  720. c.seq = nlh->nlmsg_seq;
  721. c.pid = nlh->nlmsg_pid;
  722. km_policy_notify(xp, p->dir, &c);
  723. }
  724. xfrm_pol_put(xp);
  725. return err;
  726. }
  727. static int xfrm_flush_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  728. {
  729. struct km_event c;
  730. struct xfrm_usersa_flush *p = NLMSG_DATA(nlh);
  731. xfrm_state_flush(p->proto);
  732. c.data.proto = p->proto;
  733. c.event = nlh->nlmsg_type;
  734. c.seq = nlh->nlmsg_seq;
  735. c.pid = nlh->nlmsg_pid;
  736. km_state_notify(NULL, &c);
  737. return 0;
  738. }
  739. static int xfrm_flush_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
  740. {
  741. struct km_event c;
  742. xfrm_policy_flush();
  743. c.event = nlh->nlmsg_type;
  744. c.seq = nlh->nlmsg_seq;
  745. c.pid = nlh->nlmsg_pid;
  746. km_policy_notify(NULL, 0, &c);
  747. return 0;
  748. }
  749. #define XMSGSIZE(type) NLMSG_LENGTH(sizeof(struct type))
  750. static const int xfrm_msg_min[XFRM_NR_MSGTYPES] = {
  751. [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
  752. [XFRM_MSG_DELSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
  753. [XFRM_MSG_GETSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
  754. [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
  755. [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
  756. [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
  757. [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userspi_info),
  758. [XFRM_MSG_ACQUIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_acquire),
  759. [XFRM_MSG_EXPIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_expire),
  760. [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
  761. [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
  762. [XFRM_MSG_POLEXPIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_polexpire),
  763. [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_flush),
  764. [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = NLMSG_LENGTH(0),
  765. };
  766. #undef XMSGSIZE
  767. static struct xfrm_link {
  768. int (*doit)(struct sk_buff *, struct nlmsghdr *, void **);
  769. int (*dump)(struct sk_buff *, struct netlink_callback *);
  770. } xfrm_dispatch[XFRM_NR_MSGTYPES] = {
  771. [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
  772. [XFRM_MSG_DELSA - XFRM_MSG_BASE] = { .doit = xfrm_del_sa },
  773. [XFRM_MSG_GETSA - XFRM_MSG_BASE] = { .doit = xfrm_get_sa,
  774. .dump = xfrm_dump_sa },
  775. [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
  776. [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy },
  777. [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy,
  778. .dump = xfrm_dump_policy },
  779. [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = { .doit = xfrm_alloc_userspi },
  780. [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
  781. [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
  782. [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = { .doit = xfrm_flush_sa },
  783. [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_flush_policy },
  784. };
  785. static int xfrm_done(struct netlink_callback *cb)
  786. {
  787. return 0;
  788. }
  789. static int xfrm_user_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, int *errp)
  790. {
  791. struct rtattr *xfrma[XFRMA_MAX];
  792. struct xfrm_link *link;
  793. int type, min_len;
  794. if (!(nlh->nlmsg_flags & NLM_F_REQUEST))
  795. return 0;
  796. type = nlh->nlmsg_type;
  797. /* A control message: ignore them */
  798. if (type < XFRM_MSG_BASE)
  799. return 0;
  800. /* Unknown message: reply with EINVAL */
  801. if (type > XFRM_MSG_MAX)
  802. goto err_einval;
  803. type -= XFRM_MSG_BASE;
  804. link = &xfrm_dispatch[type];
  805. /* All operations require privileges, even GET */
  806. if (security_netlink_recv(skb)) {
  807. *errp = -EPERM;
  808. return -1;
  809. }
  810. if ((type == (XFRM_MSG_GETSA - XFRM_MSG_BASE) ||
  811. type == (XFRM_MSG_GETPOLICY - XFRM_MSG_BASE)) &&
  812. (nlh->nlmsg_flags & NLM_F_DUMP)) {
  813. u32 rlen;
  814. if (link->dump == NULL)
  815. goto err_einval;
  816. if ((*errp = netlink_dump_start(xfrm_nl, skb, nlh,
  817. link->dump,
  818. xfrm_done)) != 0) {
  819. return -1;
  820. }
  821. rlen = NLMSG_ALIGN(nlh->nlmsg_len);
  822. if (rlen > skb->len)
  823. rlen = skb->len;
  824. skb_pull(skb, rlen);
  825. return -1;
  826. }
  827. memset(xfrma, 0, sizeof(xfrma));
  828. if (nlh->nlmsg_len < (min_len = xfrm_msg_min[type]))
  829. goto err_einval;
  830. if (nlh->nlmsg_len > min_len) {
  831. int attrlen = nlh->nlmsg_len - NLMSG_ALIGN(min_len);
  832. struct rtattr *attr = (void *) nlh + NLMSG_ALIGN(min_len);
  833. while (RTA_OK(attr, attrlen)) {
  834. unsigned short flavor = attr->rta_type;
  835. if (flavor) {
  836. if (flavor > XFRMA_MAX)
  837. goto err_einval;
  838. xfrma[flavor - 1] = attr;
  839. }
  840. attr = RTA_NEXT(attr, attrlen);
  841. }
  842. }
  843. if (link->doit == NULL)
  844. goto err_einval;
  845. *errp = link->doit(skb, nlh, (void **) &xfrma);
  846. return *errp;
  847. err_einval:
  848. *errp = -EINVAL;
  849. return -1;
  850. }
  851. static int xfrm_user_rcv_skb(struct sk_buff *skb)
  852. {
  853. int err;
  854. struct nlmsghdr *nlh;
  855. while (skb->len >= NLMSG_SPACE(0)) {
  856. u32 rlen;
  857. nlh = (struct nlmsghdr *) skb->data;
  858. if (nlh->nlmsg_len < sizeof(*nlh) ||
  859. skb->len < nlh->nlmsg_len)
  860. return 0;
  861. rlen = NLMSG_ALIGN(nlh->nlmsg_len);
  862. if (rlen > skb->len)
  863. rlen = skb->len;
  864. if (xfrm_user_rcv_msg(skb, nlh, &err) < 0) {
  865. if (err == 0)
  866. return -1;
  867. netlink_ack(skb, nlh, err);
  868. } else if (nlh->nlmsg_flags & NLM_F_ACK)
  869. netlink_ack(skb, nlh, 0);
  870. skb_pull(skb, rlen);
  871. }
  872. return 0;
  873. }
  874. static void xfrm_netlink_rcv(struct sock *sk, int len)
  875. {
  876. unsigned int qlen = skb_queue_len(&sk->sk_receive_queue);
  877. do {
  878. struct sk_buff *skb;
  879. down(&xfrm_cfg_sem);
  880. if (qlen > skb_queue_len(&sk->sk_receive_queue))
  881. qlen = skb_queue_len(&sk->sk_receive_queue);
  882. for (; qlen; qlen--) {
  883. skb = skb_dequeue(&sk->sk_receive_queue);
  884. if (xfrm_user_rcv_skb(skb)) {
  885. if (skb->len)
  886. skb_queue_head(&sk->sk_receive_queue,
  887. skb);
  888. else {
  889. kfree_skb(skb);
  890. qlen--;
  891. }
  892. break;
  893. }
  894. kfree_skb(skb);
  895. }
  896. up(&xfrm_cfg_sem);
  897. } while (qlen);
  898. }
  899. static int build_expire(struct sk_buff *skb, struct xfrm_state *x, int hard)
  900. {
  901. struct xfrm_user_expire *ue;
  902. struct nlmsghdr *nlh;
  903. unsigned char *b = skb->tail;
  904. nlh = NLMSG_PUT(skb, 0, 0, XFRM_MSG_EXPIRE,
  905. sizeof(*ue));
  906. ue = NLMSG_DATA(nlh);
  907. nlh->nlmsg_flags = 0;
  908. copy_to_user_state(x, &ue->state);
  909. ue->hard = (hard != 0) ? 1 : 0;
  910. nlh->nlmsg_len = skb->tail - b;
  911. return skb->len;
  912. nlmsg_failure:
  913. skb_trim(skb, b - skb->data);
  914. return -1;
  915. }
  916. static int xfrm_exp_state_notify(struct xfrm_state *x, struct km_event *c)
  917. {
  918. struct sk_buff *skb;
  919. int len = NLMSG_LENGTH(sizeof(struct xfrm_user_expire));
  920. skb = alloc_skb(len, GFP_ATOMIC);
  921. if (skb == NULL)
  922. return -ENOMEM;
  923. if (build_expire(skb, x, c->data.hard) < 0)
  924. BUG();
  925. NETLINK_CB(skb).dst_groups = XFRMGRP_EXPIRE;
  926. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_EXPIRE, GFP_ATOMIC);
  927. }
  928. static int xfrm_notify_sa_flush(struct km_event *c)
  929. {
  930. struct xfrm_usersa_flush *p;
  931. struct nlmsghdr *nlh;
  932. struct sk_buff *skb;
  933. unsigned char *b;
  934. int len = NLMSG_LENGTH(sizeof(struct xfrm_usersa_flush));
  935. skb = alloc_skb(len, GFP_ATOMIC);
  936. if (skb == NULL)
  937. return -ENOMEM;
  938. b = skb->tail;
  939. nlh = NLMSG_PUT(skb, c->pid, c->seq,
  940. XFRM_MSG_FLUSHSA, sizeof(*p));
  941. nlh->nlmsg_flags = 0;
  942. p = NLMSG_DATA(nlh);
  943. p->proto = c->data.proto;
  944. nlh->nlmsg_len = skb->tail - b;
  945. NETLINK_CB(skb).dst_groups = XFRMGRP_SA;
  946. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_SA, GFP_ATOMIC);
  947. nlmsg_failure:
  948. kfree_skb(skb);
  949. return -1;
  950. }
  951. static int inline xfrm_sa_len(struct xfrm_state *x)
  952. {
  953. int l = 0;
  954. if (x->aalg)
  955. l += RTA_SPACE(sizeof(*x->aalg) + (x->aalg->alg_key_len+7)/8);
  956. if (x->ealg)
  957. l += RTA_SPACE(sizeof(*x->ealg) + (x->ealg->alg_key_len+7)/8);
  958. if (x->calg)
  959. l += RTA_SPACE(sizeof(*x->calg));
  960. if (x->encap)
  961. l += RTA_SPACE(sizeof(*x->encap));
  962. return l;
  963. }
  964. static int xfrm_notify_sa(struct xfrm_state *x, struct km_event *c)
  965. {
  966. struct xfrm_usersa_info *p;
  967. struct xfrm_usersa_id *id;
  968. struct nlmsghdr *nlh;
  969. struct sk_buff *skb;
  970. unsigned char *b;
  971. int len = xfrm_sa_len(x);
  972. int headlen;
  973. headlen = sizeof(*p);
  974. if (c->event == XFRM_MSG_DELSA) {
  975. len += RTA_SPACE(headlen);
  976. headlen = sizeof(*id);
  977. }
  978. len += NLMSG_SPACE(headlen);
  979. skb = alloc_skb(len, GFP_ATOMIC);
  980. if (skb == NULL)
  981. return -ENOMEM;
  982. b = skb->tail;
  983. nlh = NLMSG_PUT(skb, c->pid, c->seq, c->event, headlen);
  984. nlh->nlmsg_flags = 0;
  985. p = NLMSG_DATA(nlh);
  986. if (c->event == XFRM_MSG_DELSA) {
  987. id = NLMSG_DATA(nlh);
  988. memcpy(&id->daddr, &x->id.daddr, sizeof(id->daddr));
  989. id->spi = x->id.spi;
  990. id->family = x->props.family;
  991. id->proto = x->id.proto;
  992. p = RTA_DATA(__RTA_PUT(skb, XFRMA_SA, sizeof(*p)));
  993. }
  994. copy_to_user_state(x, p);
  995. if (x->aalg)
  996. RTA_PUT(skb, XFRMA_ALG_AUTH,
  997. sizeof(*(x->aalg))+(x->aalg->alg_key_len+7)/8, x->aalg);
  998. if (x->ealg)
  999. RTA_PUT(skb, XFRMA_ALG_CRYPT,
  1000. sizeof(*(x->ealg))+(x->ealg->alg_key_len+7)/8, x->ealg);
  1001. if (x->calg)
  1002. RTA_PUT(skb, XFRMA_ALG_COMP, sizeof(*(x->calg)), x->calg);
  1003. if (x->encap)
  1004. RTA_PUT(skb, XFRMA_ENCAP, sizeof(*x->encap), x->encap);
  1005. nlh->nlmsg_len = skb->tail - b;
  1006. NETLINK_CB(skb).dst_groups = XFRMGRP_SA;
  1007. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_SA, GFP_ATOMIC);
  1008. nlmsg_failure:
  1009. rtattr_failure:
  1010. kfree_skb(skb);
  1011. return -1;
  1012. }
  1013. static int xfrm_send_state_notify(struct xfrm_state *x, struct km_event *c)
  1014. {
  1015. switch (c->event) {
  1016. case XFRM_MSG_EXPIRE:
  1017. return xfrm_exp_state_notify(x, c);
  1018. case XFRM_MSG_DELSA:
  1019. case XFRM_MSG_UPDSA:
  1020. case XFRM_MSG_NEWSA:
  1021. return xfrm_notify_sa(x, c);
  1022. case XFRM_MSG_FLUSHSA:
  1023. return xfrm_notify_sa_flush(c);
  1024. default:
  1025. printk("xfrm_user: Unknown SA event %d\n", c->event);
  1026. break;
  1027. }
  1028. return 0;
  1029. }
  1030. static int build_acquire(struct sk_buff *skb, struct xfrm_state *x,
  1031. struct xfrm_tmpl *xt, struct xfrm_policy *xp,
  1032. int dir)
  1033. {
  1034. struct xfrm_user_acquire *ua;
  1035. struct nlmsghdr *nlh;
  1036. unsigned char *b = skb->tail;
  1037. __u32 seq = xfrm_get_acqseq();
  1038. nlh = NLMSG_PUT(skb, 0, 0, XFRM_MSG_ACQUIRE,
  1039. sizeof(*ua));
  1040. ua = NLMSG_DATA(nlh);
  1041. nlh->nlmsg_flags = 0;
  1042. memcpy(&ua->id, &x->id, sizeof(ua->id));
  1043. memcpy(&ua->saddr, &x->props.saddr, sizeof(ua->saddr));
  1044. memcpy(&ua->sel, &x->sel, sizeof(ua->sel));
  1045. copy_to_user_policy(xp, &ua->policy, dir);
  1046. ua->aalgos = xt->aalgos;
  1047. ua->ealgos = xt->ealgos;
  1048. ua->calgos = xt->calgos;
  1049. ua->seq = x->km.seq = seq;
  1050. if (copy_to_user_tmpl(xp, skb) < 0)
  1051. goto nlmsg_failure;
  1052. nlh->nlmsg_len = skb->tail - b;
  1053. return skb->len;
  1054. nlmsg_failure:
  1055. skb_trim(skb, b - skb->data);
  1056. return -1;
  1057. }
  1058. static int xfrm_send_acquire(struct xfrm_state *x, struct xfrm_tmpl *xt,
  1059. struct xfrm_policy *xp, int dir)
  1060. {
  1061. struct sk_buff *skb;
  1062. size_t len;
  1063. len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
  1064. len += NLMSG_SPACE(sizeof(struct xfrm_user_acquire));
  1065. skb = alloc_skb(len, GFP_ATOMIC);
  1066. if (skb == NULL)
  1067. return -ENOMEM;
  1068. if (build_acquire(skb, x, xt, xp, dir) < 0)
  1069. BUG();
  1070. NETLINK_CB(skb).dst_groups = XFRMGRP_ACQUIRE;
  1071. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_ACQUIRE, GFP_ATOMIC);
  1072. }
  1073. /* User gives us xfrm_user_policy_info followed by an array of 0
  1074. * or more templates.
  1075. */
  1076. static struct xfrm_policy *xfrm_compile_policy(u16 family, int opt,
  1077. u8 *data, int len, int *dir)
  1078. {
  1079. struct xfrm_userpolicy_info *p = (struct xfrm_userpolicy_info *)data;
  1080. struct xfrm_user_tmpl *ut = (struct xfrm_user_tmpl *) (p + 1);
  1081. struct xfrm_policy *xp;
  1082. int nr;
  1083. switch (family) {
  1084. case AF_INET:
  1085. if (opt != IP_XFRM_POLICY) {
  1086. *dir = -EOPNOTSUPP;
  1087. return NULL;
  1088. }
  1089. break;
  1090. #if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
  1091. case AF_INET6:
  1092. if (opt != IPV6_XFRM_POLICY) {
  1093. *dir = -EOPNOTSUPP;
  1094. return NULL;
  1095. }
  1096. break;
  1097. #endif
  1098. default:
  1099. *dir = -EINVAL;
  1100. return NULL;
  1101. }
  1102. *dir = -EINVAL;
  1103. if (len < sizeof(*p) ||
  1104. verify_newpolicy_info(p))
  1105. return NULL;
  1106. nr = ((len - sizeof(*p)) / sizeof(*ut));
  1107. if (nr > XFRM_MAX_DEPTH)
  1108. return NULL;
  1109. if (p->dir > XFRM_POLICY_OUT)
  1110. return NULL;
  1111. xp = xfrm_policy_alloc(GFP_KERNEL);
  1112. if (xp == NULL) {
  1113. *dir = -ENOBUFS;
  1114. return NULL;
  1115. }
  1116. copy_from_user_policy(xp, p);
  1117. copy_templates(xp, ut, nr);
  1118. *dir = p->dir;
  1119. return xp;
  1120. }
  1121. static int build_polexpire(struct sk_buff *skb, struct xfrm_policy *xp,
  1122. int dir, int hard)
  1123. {
  1124. struct xfrm_user_polexpire *upe;
  1125. struct nlmsghdr *nlh;
  1126. unsigned char *b = skb->tail;
  1127. nlh = NLMSG_PUT(skb, 0, 0, XFRM_MSG_POLEXPIRE, sizeof(*upe));
  1128. upe = NLMSG_DATA(nlh);
  1129. nlh->nlmsg_flags = 0;
  1130. copy_to_user_policy(xp, &upe->pol, dir);
  1131. if (copy_to_user_tmpl(xp, skb) < 0)
  1132. goto nlmsg_failure;
  1133. upe->hard = !!hard;
  1134. nlh->nlmsg_len = skb->tail - b;
  1135. return skb->len;
  1136. nlmsg_failure:
  1137. skb_trim(skb, b - skb->data);
  1138. return -1;
  1139. }
  1140. static int xfrm_exp_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
  1141. {
  1142. struct sk_buff *skb;
  1143. size_t len;
  1144. len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
  1145. len += NLMSG_SPACE(sizeof(struct xfrm_user_polexpire));
  1146. skb = alloc_skb(len, GFP_ATOMIC);
  1147. if (skb == NULL)
  1148. return -ENOMEM;
  1149. if (build_polexpire(skb, xp, dir, c->data.hard) < 0)
  1150. BUG();
  1151. NETLINK_CB(skb).dst_groups = XFRMGRP_EXPIRE;
  1152. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_EXPIRE, GFP_ATOMIC);
  1153. }
  1154. static int xfrm_notify_policy(struct xfrm_policy *xp, int dir, struct km_event *c)
  1155. {
  1156. struct xfrm_userpolicy_info *p;
  1157. struct xfrm_userpolicy_id *id;
  1158. struct nlmsghdr *nlh;
  1159. struct sk_buff *skb;
  1160. unsigned char *b;
  1161. int len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
  1162. int headlen;
  1163. headlen = sizeof(*p);
  1164. if (c->event == XFRM_MSG_DELPOLICY) {
  1165. len += RTA_SPACE(headlen);
  1166. headlen = sizeof(*id);
  1167. }
  1168. len += NLMSG_SPACE(headlen);
  1169. skb = alloc_skb(len, GFP_ATOMIC);
  1170. if (skb == NULL)
  1171. return -ENOMEM;
  1172. b = skb->tail;
  1173. nlh = NLMSG_PUT(skb, c->pid, c->seq, c->event, headlen);
  1174. p = NLMSG_DATA(nlh);
  1175. if (c->event == XFRM_MSG_DELPOLICY) {
  1176. id = NLMSG_DATA(nlh);
  1177. memset(id, 0, sizeof(*id));
  1178. id->dir = dir;
  1179. if (c->data.byid)
  1180. id->index = xp->index;
  1181. else
  1182. memcpy(&id->sel, &xp->selector, sizeof(id->sel));
  1183. p = RTA_DATA(__RTA_PUT(skb, XFRMA_POLICY, sizeof(*p)));
  1184. }
  1185. nlh->nlmsg_flags = 0;
  1186. copy_to_user_policy(xp, p, dir);
  1187. if (copy_to_user_tmpl(xp, skb) < 0)
  1188. goto nlmsg_failure;
  1189. nlh->nlmsg_len = skb->tail - b;
  1190. NETLINK_CB(skb).dst_groups = XFRMGRP_POLICY;
  1191. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_POLICY, GFP_ATOMIC);
  1192. nlmsg_failure:
  1193. rtattr_failure:
  1194. kfree_skb(skb);
  1195. return -1;
  1196. }
  1197. static int xfrm_notify_policy_flush(struct km_event *c)
  1198. {
  1199. struct nlmsghdr *nlh;
  1200. struct sk_buff *skb;
  1201. unsigned char *b;
  1202. int len = NLMSG_LENGTH(0);
  1203. skb = alloc_skb(len, GFP_ATOMIC);
  1204. if (skb == NULL)
  1205. return -ENOMEM;
  1206. b = skb->tail;
  1207. nlh = NLMSG_PUT(skb, c->pid, c->seq, XFRM_MSG_FLUSHPOLICY, 0);
  1208. nlh->nlmsg_len = skb->tail - b;
  1209. NETLINK_CB(skb).dst_groups = XFRMGRP_POLICY;
  1210. return netlink_broadcast(xfrm_nl, skb, 0, XFRMGRP_POLICY, GFP_ATOMIC);
  1211. nlmsg_failure:
  1212. kfree_skb(skb);
  1213. return -1;
  1214. }
  1215. static int xfrm_send_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
  1216. {
  1217. switch (c->event) {
  1218. case XFRM_MSG_NEWPOLICY:
  1219. case XFRM_MSG_UPDPOLICY:
  1220. case XFRM_MSG_DELPOLICY:
  1221. return xfrm_notify_policy(xp, dir, c);
  1222. case XFRM_MSG_FLUSHPOLICY:
  1223. return xfrm_notify_policy_flush(c);
  1224. case XFRM_MSG_POLEXPIRE:
  1225. return xfrm_exp_policy_notify(xp, dir, c);
  1226. default:
  1227. printk("xfrm_user: Unknown Policy event %d\n", c->event);
  1228. }
  1229. return 0;
  1230. }
  1231. static struct xfrm_mgr netlink_mgr = {
  1232. .id = "netlink",
  1233. .notify = xfrm_send_state_notify,
  1234. .acquire = xfrm_send_acquire,
  1235. .compile_policy = xfrm_compile_policy,
  1236. .notify_policy = xfrm_send_policy_notify,
  1237. };
  1238. static int __init xfrm_user_init(void)
  1239. {
  1240. printk(KERN_INFO "Initializing IPsec netlink socket\n");
  1241. xfrm_nl = netlink_kernel_create(NETLINK_XFRM, xfrm_netlink_rcv,
  1242. THIS_MODULE);
  1243. if (xfrm_nl == NULL)
  1244. return -ENOMEM;
  1245. xfrm_register_km(&netlink_mgr);
  1246. return 0;
  1247. }
  1248. static void __exit xfrm_user_exit(void)
  1249. {
  1250. xfrm_unregister_km(&netlink_mgr);
  1251. sock_release(xfrm_nl->sk_socket);
  1252. }
  1253. module_init(xfrm_user_init);
  1254. module_exit(xfrm_user_exit);
  1255. MODULE_LICENSE("GPL");
  1256. MODULE_ALIAS_NET_PF_PROTO(PF_NETLINK, NETLINK_XFRM);