xfrm_user.c 33 KB

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