123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560 |
- /*
- * xfrm_state.c
- *
- * Changes:
- * Mitsuru KANDA @USAGI
- * Kazunori MIYAZAWA @USAGI
- * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
- * IPv6 support
- * YOSHIFUJI Hideaki @USAGI
- * Split up af-specific functions
- * Derek Atkins <derek@ihtfp.com>
- * Add UDP Encapsulation
- *
- */
- #include <linux/workqueue.h>
- #include <net/xfrm.h>
- #include <linux/pfkeyv2.h>
- #include <linux/ipsec.h>
- #include <linux/module.h>
- #include <linux/cache.h>
- #include <asm/uaccess.h>
- #include "xfrm_hash.h"
- struct sock *xfrm_nl;
- EXPORT_SYMBOL(xfrm_nl);
- u32 sysctl_xfrm_aevent_etime = XFRM_AE_ETIME;
- EXPORT_SYMBOL(sysctl_xfrm_aevent_etime);
- u32 sysctl_xfrm_aevent_rseqth = XFRM_AE_SEQT_SIZE;
- EXPORT_SYMBOL(sysctl_xfrm_aevent_rseqth);
- /* Each xfrm_state may be linked to two tables:
- 1. Hash table by (spi,daddr,ah/esp) to find SA by SPI. (input,ctl)
- 2. Hash table by (daddr,family,reqid) to find what SAs exist for given
- destination/tunnel endpoint. (output)
- */
- static DEFINE_SPINLOCK(xfrm_state_lock);
- /* Hash table to find appropriate SA towards given target (endpoint
- * of tunnel or destination of transport mode) allowed by selector.
- *
- * Main use is finding SA after policy selected tunnel or transport mode.
- * Also, it can be used by ah/esp icmp error handler to find offending SA.
- */
- static struct hlist_head *xfrm_state_bydst __read_mostly;
- static struct hlist_head *xfrm_state_bysrc __read_mostly;
- static struct hlist_head *xfrm_state_byspi __read_mostly;
- static unsigned int xfrm_state_hmask __read_mostly;
- static unsigned int xfrm_state_hashmax __read_mostly = 1 * 1024 * 1024;
- static unsigned int xfrm_state_num;
- static unsigned int xfrm_state_genid;
- static inline unsigned int xfrm_dst_hash(xfrm_address_t *daddr,
- xfrm_address_t *saddr,
- u32 reqid,
- unsigned short family)
- {
- return __xfrm_dst_hash(daddr, saddr, reqid, family, xfrm_state_hmask);
- }
- static inline unsigned int xfrm_src_hash(xfrm_address_t *addr,
- unsigned short family)
- {
- return __xfrm_src_hash(addr, family, xfrm_state_hmask);
- }
- static inline unsigned int
- xfrm_spi_hash(xfrm_address_t *daddr, __be32 spi, u8 proto, unsigned short family)
- {
- return __xfrm_spi_hash(daddr, spi, proto, family, xfrm_state_hmask);
- }
- static void xfrm_hash_transfer(struct hlist_head *list,
- struct hlist_head *ndsttable,
- struct hlist_head *nsrctable,
- struct hlist_head *nspitable,
- unsigned int nhashmask)
- {
- struct hlist_node *entry, *tmp;
- struct xfrm_state *x;
- hlist_for_each_entry_safe(x, entry, tmp, list, bydst) {
- unsigned int h;
- h = __xfrm_dst_hash(&x->id.daddr, &x->props.saddr,
- x->props.reqid, x->props.family,
- nhashmask);
- hlist_add_head(&x->bydst, ndsttable+h);
- h = __xfrm_src_hash(&x->props.saddr, x->props.family,
- nhashmask);
- hlist_add_head(&x->bysrc, nsrctable+h);
- if (x->id.spi) {
- h = __xfrm_spi_hash(&x->id.daddr, x->id.spi,
- x->id.proto, x->props.family,
- nhashmask);
- hlist_add_head(&x->byspi, nspitable+h);
- }
- }
- }
- static unsigned long xfrm_hash_new_size(void)
- {
- return ((xfrm_state_hmask + 1) << 1) *
- sizeof(struct hlist_head);
- }
- static DEFINE_MUTEX(hash_resize_mutex);
- static void xfrm_hash_resize(void *__unused)
- {
- struct hlist_head *ndst, *nsrc, *nspi, *odst, *osrc, *ospi;
- unsigned long nsize, osize;
- unsigned int nhashmask, ohashmask;
- int i;
- mutex_lock(&hash_resize_mutex);
- nsize = xfrm_hash_new_size();
- ndst = xfrm_hash_alloc(nsize);
- if (!ndst)
- goto out_unlock;
- nsrc = xfrm_hash_alloc(nsize);
- if (!nsrc) {
- xfrm_hash_free(ndst, nsize);
- goto out_unlock;
- }
- nspi = xfrm_hash_alloc(nsize);
- if (!nspi) {
- xfrm_hash_free(ndst, nsize);
- xfrm_hash_free(nsrc, nsize);
- goto out_unlock;
- }
- spin_lock_bh(&xfrm_state_lock);
- nhashmask = (nsize / sizeof(struct hlist_head)) - 1U;
- for (i = xfrm_state_hmask; i >= 0; i--)
- xfrm_hash_transfer(xfrm_state_bydst+i, ndst, nsrc, nspi,
- nhashmask);
- odst = xfrm_state_bydst;
- osrc = xfrm_state_bysrc;
- ospi = xfrm_state_byspi;
- ohashmask = xfrm_state_hmask;
- xfrm_state_bydst = ndst;
- xfrm_state_bysrc = nsrc;
- xfrm_state_byspi = nspi;
- xfrm_state_hmask = nhashmask;
- spin_unlock_bh(&xfrm_state_lock);
- osize = (ohashmask + 1) * sizeof(struct hlist_head);
- xfrm_hash_free(odst, osize);
- xfrm_hash_free(osrc, osize);
- xfrm_hash_free(ospi, osize);
- out_unlock:
- mutex_unlock(&hash_resize_mutex);
- }
- static DECLARE_WORK(xfrm_hash_work, xfrm_hash_resize, NULL);
- DECLARE_WAIT_QUEUE_HEAD(km_waitq);
- EXPORT_SYMBOL(km_waitq);
- static DEFINE_RWLOCK(xfrm_state_afinfo_lock);
- static struct xfrm_state_afinfo *xfrm_state_afinfo[NPROTO];
- static struct work_struct xfrm_state_gc_work;
- static HLIST_HEAD(xfrm_state_gc_list);
- static DEFINE_SPINLOCK(xfrm_state_gc_lock);
- int __xfrm_state_delete(struct xfrm_state *x);
- static struct xfrm_state_afinfo *xfrm_state_get_afinfo(unsigned short family);
- static void xfrm_state_put_afinfo(struct xfrm_state_afinfo *afinfo);
- int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol);
- void km_state_expired(struct xfrm_state *x, int hard, u32 pid);
- static void xfrm_state_gc_destroy(struct xfrm_state *x)
- {
- del_timer_sync(&x->timer);
- del_timer_sync(&x->rtimer);
- kfree(x->aalg);
- kfree(x->ealg);
- kfree(x->calg);
- kfree(x->encap);
- kfree(x->coaddr);
- if (x->mode)
- xfrm_put_mode(x->mode);
- if (x->type) {
- x->type->destructor(x);
- xfrm_put_type(x->type);
- }
- security_xfrm_state_free(x);
- kfree(x);
- }
- static void xfrm_state_gc_task(void *data)
- {
- struct xfrm_state *x;
- struct hlist_node *entry, *tmp;
- struct hlist_head gc_list;
- spin_lock_bh(&xfrm_state_gc_lock);
- gc_list.first = xfrm_state_gc_list.first;
- INIT_HLIST_HEAD(&xfrm_state_gc_list);
- spin_unlock_bh(&xfrm_state_gc_lock);
- hlist_for_each_entry_safe(x, entry, tmp, &gc_list, bydst)
- xfrm_state_gc_destroy(x);
- wake_up(&km_waitq);
- }
- static inline unsigned long make_jiffies(long secs)
- {
- if (secs >= (MAX_SCHEDULE_TIMEOUT-1)/HZ)
- return MAX_SCHEDULE_TIMEOUT-1;
- else
- return secs*HZ;
- }
- static void xfrm_timer_handler(unsigned long data)
- {
- struct xfrm_state *x = (struct xfrm_state*)data;
- unsigned long now = (unsigned long)xtime.tv_sec;
- long next = LONG_MAX;
- int warn = 0;
- spin_lock(&x->lock);
- if (x->km.state == XFRM_STATE_DEAD)
- goto out;
- if (x->km.state == XFRM_STATE_EXPIRED)
- goto expired;
- if (x->lft.hard_add_expires_seconds) {
- long tmo = x->lft.hard_add_expires_seconds +
- x->curlft.add_time - now;
- if (tmo <= 0)
- goto expired;
- if (tmo < next)
- next = tmo;
- }
- if (x->lft.hard_use_expires_seconds) {
- long tmo = x->lft.hard_use_expires_seconds +
- (x->curlft.use_time ? : now) - now;
- if (tmo <= 0)
- goto expired;
- if (tmo < next)
- next = tmo;
- }
- if (x->km.dying)
- goto resched;
- if (x->lft.soft_add_expires_seconds) {
- long tmo = x->lft.soft_add_expires_seconds +
- x->curlft.add_time - now;
- if (tmo <= 0)
- warn = 1;
- else if (tmo < next)
- next = tmo;
- }
- if (x->lft.soft_use_expires_seconds) {
- long tmo = x->lft.soft_use_expires_seconds +
- (x->curlft.use_time ? : now) - now;
- if (tmo <= 0)
- warn = 1;
- else if (tmo < next)
- next = tmo;
- }
- x->km.dying = warn;
- if (warn)
- km_state_expired(x, 0, 0);
- resched:
- if (next != LONG_MAX)
- mod_timer(&x->timer, jiffies + make_jiffies(next));
- goto out;
- expired:
- if (x->km.state == XFRM_STATE_ACQ && x->id.spi == 0) {
- x->km.state = XFRM_STATE_EXPIRED;
- wake_up(&km_waitq);
- next = 2;
- goto resched;
- }
- if (!__xfrm_state_delete(x) && x->id.spi)
- km_state_expired(x, 1, 0);
- out:
- spin_unlock(&x->lock);
- }
- static void xfrm_replay_timer_handler(unsigned long data);
- struct xfrm_state *xfrm_state_alloc(void)
- {
- struct xfrm_state *x;
- x = kzalloc(sizeof(struct xfrm_state), GFP_ATOMIC);
- if (x) {
- atomic_set(&x->refcnt, 1);
- atomic_set(&x->tunnel_users, 0);
- INIT_HLIST_NODE(&x->bydst);
- INIT_HLIST_NODE(&x->bysrc);
- INIT_HLIST_NODE(&x->byspi);
- init_timer(&x->timer);
- x->timer.function = xfrm_timer_handler;
- x->timer.data = (unsigned long)x;
- init_timer(&x->rtimer);
- x->rtimer.function = xfrm_replay_timer_handler;
- x->rtimer.data = (unsigned long)x;
- x->curlft.add_time = (unsigned long)xtime.tv_sec;
- x->lft.soft_byte_limit = XFRM_INF;
- x->lft.soft_packet_limit = XFRM_INF;
- x->lft.hard_byte_limit = XFRM_INF;
- x->lft.hard_packet_limit = XFRM_INF;
- x->replay_maxage = 0;
- x->replay_maxdiff = 0;
- spin_lock_init(&x->lock);
- }
- return x;
- }
- EXPORT_SYMBOL(xfrm_state_alloc);
- void __xfrm_state_destroy(struct xfrm_state *x)
- {
- BUG_TRAP(x->km.state == XFRM_STATE_DEAD);
- spin_lock_bh(&xfrm_state_gc_lock);
- hlist_add_head(&x->bydst, &xfrm_state_gc_list);
- spin_unlock_bh(&xfrm_state_gc_lock);
- schedule_work(&xfrm_state_gc_work);
- }
- EXPORT_SYMBOL(__xfrm_state_destroy);
- int __xfrm_state_delete(struct xfrm_state *x)
- {
- int err = -ESRCH;
- if (x->km.state != XFRM_STATE_DEAD) {
- x->km.state = XFRM_STATE_DEAD;
- spin_lock(&xfrm_state_lock);
- hlist_del(&x->bydst);
- hlist_del(&x->bysrc);
- if (x->id.spi)
- hlist_del(&x->byspi);
- xfrm_state_num--;
- spin_unlock(&xfrm_state_lock);
- /* All xfrm_state objects are created by xfrm_state_alloc.
- * The xfrm_state_alloc call gives a reference, and that
- * is what we are dropping here.
- */
- __xfrm_state_put(x);
- err = 0;
- }
- return err;
- }
- EXPORT_SYMBOL(__xfrm_state_delete);
- int xfrm_state_delete(struct xfrm_state *x)
- {
- int err;
- spin_lock_bh(&x->lock);
- err = __xfrm_state_delete(x);
- spin_unlock_bh(&x->lock);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_delete);
- void xfrm_state_flush(u8 proto)
- {
- int i;
- spin_lock_bh(&xfrm_state_lock);
- for (i = 0; i <= xfrm_state_hmask; i++) {
- struct hlist_node *entry;
- struct xfrm_state *x;
- restart:
- hlist_for_each_entry(x, entry, xfrm_state_bydst+i, bydst) {
- if (!xfrm_state_kern(x) &&
- xfrm_id_proto_match(x->id.proto, proto)) {
- xfrm_state_hold(x);
- spin_unlock_bh(&xfrm_state_lock);
- xfrm_state_delete(x);
- xfrm_state_put(x);
- spin_lock_bh(&xfrm_state_lock);
- goto restart;
- }
- }
- }
- spin_unlock_bh(&xfrm_state_lock);
- wake_up(&km_waitq);
- }
- EXPORT_SYMBOL(xfrm_state_flush);
- static int
- xfrm_init_tempsel(struct xfrm_state *x, struct flowi *fl,
- struct xfrm_tmpl *tmpl,
- xfrm_address_t *daddr, xfrm_address_t *saddr,
- unsigned short family)
- {
- struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
- if (!afinfo)
- return -1;
- afinfo->init_tempsel(x, fl, tmpl, daddr, saddr);
- xfrm_state_put_afinfo(afinfo);
- return 0;
- }
- static struct xfrm_state *__xfrm_state_lookup(xfrm_address_t *daddr, __be32 spi, u8 proto, unsigned short family)
- {
- unsigned int h = xfrm_spi_hash(daddr, spi, proto, family);
- struct xfrm_state *x;
- struct hlist_node *entry;
- hlist_for_each_entry(x, entry, xfrm_state_byspi+h, byspi) {
- if (x->props.family != family ||
- x->id.spi != spi ||
- x->id.proto != proto)
- continue;
- switch (family) {
- case AF_INET:
- if (x->id.daddr.a4 != daddr->a4)
- continue;
- break;
- case AF_INET6:
- if (!ipv6_addr_equal((struct in6_addr *)daddr,
- (struct in6_addr *)
- x->id.daddr.a6))
- continue;
- break;
- };
- xfrm_state_hold(x);
- return x;
- }
- return NULL;
- }
- static struct xfrm_state *__xfrm_state_lookup_byaddr(xfrm_address_t *daddr, xfrm_address_t *saddr, u8 proto, unsigned short family)
- {
- unsigned int h = xfrm_src_hash(saddr, family);
- struct xfrm_state *x;
- struct hlist_node *entry;
- hlist_for_each_entry(x, entry, xfrm_state_bysrc+h, bysrc) {
- if (x->props.family != family ||
- x->id.proto != proto)
- continue;
- switch (family) {
- case AF_INET:
- if (x->id.daddr.a4 != daddr->a4 ||
- x->props.saddr.a4 != saddr->a4)
- continue;
- break;
- case AF_INET6:
- if (!ipv6_addr_equal((struct in6_addr *)daddr,
- (struct in6_addr *)
- x->id.daddr.a6) ||
- !ipv6_addr_equal((struct in6_addr *)saddr,
- (struct in6_addr *)
- x->props.saddr.a6))
- continue;
- break;
- };
- xfrm_state_hold(x);
- return x;
- }
- return NULL;
- }
- static inline struct xfrm_state *
- __xfrm_state_locate(struct xfrm_state *x, int use_spi, int family)
- {
- if (use_spi)
- return __xfrm_state_lookup(&x->id.daddr, x->id.spi,
- x->id.proto, family);
- else
- return __xfrm_state_lookup_byaddr(&x->id.daddr,
- &x->props.saddr,
- x->id.proto, family);
- }
- struct xfrm_state *
- xfrm_state_find(xfrm_address_t *daddr, xfrm_address_t *saddr,
- struct flowi *fl, struct xfrm_tmpl *tmpl,
- struct xfrm_policy *pol, int *err,
- unsigned short family)
- {
- unsigned int h = xfrm_dst_hash(daddr, saddr, tmpl->reqid, family);
- struct hlist_node *entry;
- struct xfrm_state *x, *x0;
- int acquire_in_progress = 0;
- int error = 0;
- struct xfrm_state *best = NULL;
-
- spin_lock_bh(&xfrm_state_lock);
- hlist_for_each_entry(x, entry, xfrm_state_bydst+h, bydst) {
- if (x->props.family == family &&
- x->props.reqid == tmpl->reqid &&
- !(x->props.flags & XFRM_STATE_WILDRECV) &&
- xfrm_state_addr_check(x, daddr, saddr, family) &&
- tmpl->mode == x->props.mode &&
- tmpl->id.proto == x->id.proto &&
- (tmpl->id.spi == x->id.spi || !tmpl->id.spi)) {
- /* Resolution logic:
- 1. There is a valid state with matching selector.
- Done.
- 2. Valid state with inappropriate selector. Skip.
- Entering area of "sysdeps".
- 3. If state is not valid, selector is temporary,
- it selects only session which triggered
- previous resolution. Key manager will do
- something to install a state with proper
- selector.
- */
- if (x->km.state == XFRM_STATE_VALID) {
- if (!xfrm_selector_match(&x->sel, fl, family) ||
- !security_xfrm_state_pol_flow_match(x, pol, fl))
- continue;
- if (!best ||
- best->km.dying > x->km.dying ||
- (best->km.dying == x->km.dying &&
- best->curlft.add_time < x->curlft.add_time))
- best = x;
- } else if (x->km.state == XFRM_STATE_ACQ) {
- acquire_in_progress = 1;
- } else if (x->km.state == XFRM_STATE_ERROR ||
- x->km.state == XFRM_STATE_EXPIRED) {
- if (xfrm_selector_match(&x->sel, fl, family) &&
- security_xfrm_state_pol_flow_match(x, pol, fl))
- error = -ESRCH;
- }
- }
- }
- x = best;
- if (!x && !error && !acquire_in_progress) {
- if (tmpl->id.spi &&
- (x0 = __xfrm_state_lookup(daddr, tmpl->id.spi,
- tmpl->id.proto, family)) != NULL) {
- xfrm_state_put(x0);
- error = -EEXIST;
- goto out;
- }
- x = xfrm_state_alloc();
- if (x == NULL) {
- error = -ENOMEM;
- goto out;
- }
- /* Initialize temporary selector matching only
- * to current session. */
- xfrm_init_tempsel(x, fl, tmpl, daddr, saddr, family);
- error = security_xfrm_state_alloc_acquire(x, pol->security, fl->secid);
- if (error) {
- x->km.state = XFRM_STATE_DEAD;
- xfrm_state_put(x);
- x = NULL;
- goto out;
- }
- if (km_query(x, tmpl, pol) == 0) {
- x->km.state = XFRM_STATE_ACQ;
- hlist_add_head(&x->bydst, xfrm_state_bydst+h);
- h = xfrm_src_hash(saddr, family);
- hlist_add_head(&x->bysrc, xfrm_state_bysrc+h);
- if (x->id.spi) {
- h = xfrm_spi_hash(&x->id.daddr, x->id.spi, x->id.proto, family);
- hlist_add_head(&x->byspi, xfrm_state_byspi+h);
- }
- x->lft.hard_add_expires_seconds = XFRM_ACQ_EXPIRES;
- x->timer.expires = jiffies + XFRM_ACQ_EXPIRES*HZ;
- add_timer(&x->timer);
- } else {
- x->km.state = XFRM_STATE_DEAD;
- xfrm_state_put(x);
- x = NULL;
- error = -ESRCH;
- }
- }
- out:
- if (x)
- xfrm_state_hold(x);
- else
- *err = acquire_in_progress ? -EAGAIN : error;
- spin_unlock_bh(&xfrm_state_lock);
- return x;
- }
- static void __xfrm_state_insert(struct xfrm_state *x)
- {
- unsigned int h;
- x->genid = ++xfrm_state_genid;
- h = xfrm_dst_hash(&x->id.daddr, &x->props.saddr,
- x->props.reqid, x->props.family);
- hlist_add_head(&x->bydst, xfrm_state_bydst+h);
- h = xfrm_src_hash(&x->props.saddr, x->props.family);
- hlist_add_head(&x->bysrc, xfrm_state_bysrc+h);
- if (x->id.spi) {
- h = xfrm_spi_hash(&x->id.daddr, x->id.spi, x->id.proto,
- x->props.family);
- hlist_add_head(&x->byspi, xfrm_state_byspi+h);
- }
- mod_timer(&x->timer, jiffies + HZ);
- if (x->replay_maxage)
- mod_timer(&x->rtimer, jiffies + x->replay_maxage);
- wake_up(&km_waitq);
- xfrm_state_num++;
- if (x->bydst.next != NULL &&
- (xfrm_state_hmask + 1) < xfrm_state_hashmax &&
- xfrm_state_num > xfrm_state_hmask)
- schedule_work(&xfrm_hash_work);
- }
- /* xfrm_state_lock is held */
- static void __xfrm_state_bump_genids(struct xfrm_state *xnew)
- {
- unsigned short family = xnew->props.family;
- u32 reqid = xnew->props.reqid;
- struct xfrm_state *x;
- struct hlist_node *entry;
- unsigned int h;
- h = xfrm_dst_hash(&xnew->id.daddr, &xnew->props.saddr, reqid, family);
- hlist_for_each_entry(x, entry, xfrm_state_bydst+h, bydst) {
- if (x->props.family == family &&
- x->props.reqid == reqid &&
- !xfrm_addr_cmp(&x->id.daddr, &xnew->id.daddr, family) &&
- !xfrm_addr_cmp(&x->props.saddr, &xnew->props.saddr, family))
- x->genid = xfrm_state_genid;
- }
- }
- void xfrm_state_insert(struct xfrm_state *x)
- {
- spin_lock_bh(&xfrm_state_lock);
- __xfrm_state_bump_genids(x);
- __xfrm_state_insert(x);
- spin_unlock_bh(&xfrm_state_lock);
- }
- EXPORT_SYMBOL(xfrm_state_insert);
- /* xfrm_state_lock is held */
- static struct xfrm_state *__find_acq_core(unsigned short family, u8 mode, u32 reqid, u8 proto, xfrm_address_t *daddr, xfrm_address_t *saddr, int create)
- {
- unsigned int h = xfrm_dst_hash(daddr, saddr, reqid, family);
- struct hlist_node *entry;
- struct xfrm_state *x;
- hlist_for_each_entry(x, entry, xfrm_state_bydst+h, bydst) {
- if (x->props.reqid != reqid ||
- x->props.mode != mode ||
- x->props.family != family ||
- x->km.state != XFRM_STATE_ACQ ||
- x->id.spi != 0)
- continue;
- switch (family) {
- case AF_INET:
- if (x->id.daddr.a4 != daddr->a4 ||
- x->props.saddr.a4 != saddr->a4)
- continue;
- break;
- case AF_INET6:
- if (!ipv6_addr_equal((struct in6_addr *)x->id.daddr.a6,
- (struct in6_addr *)daddr) ||
- !ipv6_addr_equal((struct in6_addr *)
- x->props.saddr.a6,
- (struct in6_addr *)saddr))
- continue;
- break;
- };
- xfrm_state_hold(x);
- return x;
- }
- if (!create)
- return NULL;
- x = xfrm_state_alloc();
- if (likely(x)) {
- switch (family) {
- case AF_INET:
- x->sel.daddr.a4 = daddr->a4;
- x->sel.saddr.a4 = saddr->a4;
- x->sel.prefixlen_d = 32;
- x->sel.prefixlen_s = 32;
- x->props.saddr.a4 = saddr->a4;
- x->id.daddr.a4 = daddr->a4;
- break;
- case AF_INET6:
- ipv6_addr_copy((struct in6_addr *)x->sel.daddr.a6,
- (struct in6_addr *)daddr);
- ipv6_addr_copy((struct in6_addr *)x->sel.saddr.a6,
- (struct in6_addr *)saddr);
- x->sel.prefixlen_d = 128;
- x->sel.prefixlen_s = 128;
- ipv6_addr_copy((struct in6_addr *)x->props.saddr.a6,
- (struct in6_addr *)saddr);
- ipv6_addr_copy((struct in6_addr *)x->id.daddr.a6,
- (struct in6_addr *)daddr);
- break;
- };
- x->km.state = XFRM_STATE_ACQ;
- x->id.proto = proto;
- x->props.family = family;
- x->props.mode = mode;
- x->props.reqid = reqid;
- x->lft.hard_add_expires_seconds = XFRM_ACQ_EXPIRES;
- xfrm_state_hold(x);
- x->timer.expires = jiffies + XFRM_ACQ_EXPIRES*HZ;
- add_timer(&x->timer);
- hlist_add_head(&x->bydst, xfrm_state_bydst+h);
- h = xfrm_src_hash(saddr, family);
- hlist_add_head(&x->bysrc, xfrm_state_bysrc+h);
- wake_up(&km_waitq);
- }
- return x;
- }
- static struct xfrm_state *__xfrm_find_acq_byseq(u32 seq);
- int xfrm_state_add(struct xfrm_state *x)
- {
- struct xfrm_state *x1;
- int family;
- int err;
- int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
- family = x->props.family;
- spin_lock_bh(&xfrm_state_lock);
- x1 = __xfrm_state_locate(x, use_spi, family);
- if (x1) {
- xfrm_state_put(x1);
- x1 = NULL;
- err = -EEXIST;
- goto out;
- }
- if (use_spi && x->km.seq) {
- x1 = __xfrm_find_acq_byseq(x->km.seq);
- if (x1 && xfrm_addr_cmp(&x1->id.daddr, &x->id.daddr, family)) {
- xfrm_state_put(x1);
- x1 = NULL;
- }
- }
- if (use_spi && !x1)
- x1 = __find_acq_core(family, x->props.mode, x->props.reqid,
- x->id.proto,
- &x->id.daddr, &x->props.saddr, 0);
- __xfrm_state_bump_genids(x);
- __xfrm_state_insert(x);
- err = 0;
- out:
- spin_unlock_bh(&xfrm_state_lock);
- if (x1) {
- xfrm_state_delete(x1);
- xfrm_state_put(x1);
- }
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_add);
- int xfrm_state_update(struct xfrm_state *x)
- {
- struct xfrm_state *x1;
- int err;
- int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
- spin_lock_bh(&xfrm_state_lock);
- x1 = __xfrm_state_locate(x, use_spi, x->props.family);
- err = -ESRCH;
- if (!x1)
- goto out;
- if (xfrm_state_kern(x1)) {
- xfrm_state_put(x1);
- err = -EEXIST;
- goto out;
- }
- if (x1->km.state == XFRM_STATE_ACQ) {
- __xfrm_state_insert(x);
- x = NULL;
- }
- err = 0;
- out:
- spin_unlock_bh(&xfrm_state_lock);
- if (err)
- return err;
- if (!x) {
- xfrm_state_delete(x1);
- xfrm_state_put(x1);
- return 0;
- }
- err = -EINVAL;
- spin_lock_bh(&x1->lock);
- if (likely(x1->km.state == XFRM_STATE_VALID)) {
- if (x->encap && x1->encap)
- memcpy(x1->encap, x->encap, sizeof(*x1->encap));
- if (x->coaddr && x1->coaddr) {
- memcpy(x1->coaddr, x->coaddr, sizeof(*x1->coaddr));
- }
- if (!use_spi && memcmp(&x1->sel, &x->sel, sizeof(x1->sel)))
- memcpy(&x1->sel, &x->sel, sizeof(x1->sel));
- memcpy(&x1->lft, &x->lft, sizeof(x1->lft));
- x1->km.dying = 0;
- mod_timer(&x1->timer, jiffies + HZ);
- if (x1->curlft.use_time)
- xfrm_state_check_expire(x1);
- err = 0;
- }
- spin_unlock_bh(&x1->lock);
- xfrm_state_put(x1);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_update);
- int xfrm_state_check_expire(struct xfrm_state *x)
- {
- if (!x->curlft.use_time)
- x->curlft.use_time = (unsigned long)xtime.tv_sec;
- if (x->km.state != XFRM_STATE_VALID)
- return -EINVAL;
- if (x->curlft.bytes >= x->lft.hard_byte_limit ||
- x->curlft.packets >= x->lft.hard_packet_limit) {
- x->km.state = XFRM_STATE_EXPIRED;
- mod_timer(&x->timer, jiffies);
- return -EINVAL;
- }
- if (!x->km.dying &&
- (x->curlft.bytes >= x->lft.soft_byte_limit ||
- x->curlft.packets >= x->lft.soft_packet_limit)) {
- x->km.dying = 1;
- km_state_expired(x, 0, 0);
- }
- return 0;
- }
- EXPORT_SYMBOL(xfrm_state_check_expire);
- static int xfrm_state_check_space(struct xfrm_state *x, struct sk_buff *skb)
- {
- int nhead = x->props.header_len + LL_RESERVED_SPACE(skb->dst->dev)
- - skb_headroom(skb);
- if (nhead > 0)
- return pskb_expand_head(skb, nhead, 0, GFP_ATOMIC);
- /* Check tail too... */
- return 0;
- }
- int xfrm_state_check(struct xfrm_state *x, struct sk_buff *skb)
- {
- int err = xfrm_state_check_expire(x);
- if (err < 0)
- goto err;
- err = xfrm_state_check_space(x, skb);
- err:
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_check);
- struct xfrm_state *
- xfrm_state_lookup(xfrm_address_t *daddr, __be32 spi, u8 proto,
- unsigned short family)
- {
- struct xfrm_state *x;
- spin_lock_bh(&xfrm_state_lock);
- x = __xfrm_state_lookup(daddr, spi, proto, family);
- spin_unlock_bh(&xfrm_state_lock);
- return x;
- }
- EXPORT_SYMBOL(xfrm_state_lookup);
- struct xfrm_state *
- xfrm_state_lookup_byaddr(xfrm_address_t *daddr, xfrm_address_t *saddr,
- u8 proto, unsigned short family)
- {
- struct xfrm_state *x;
- spin_lock_bh(&xfrm_state_lock);
- x = __xfrm_state_lookup_byaddr(daddr, saddr, proto, family);
- spin_unlock_bh(&xfrm_state_lock);
- return x;
- }
- EXPORT_SYMBOL(xfrm_state_lookup_byaddr);
- struct xfrm_state *
- xfrm_find_acq(u8 mode, u32 reqid, u8 proto,
- xfrm_address_t *daddr, xfrm_address_t *saddr,
- int create, unsigned short family)
- {
- struct xfrm_state *x;
- spin_lock_bh(&xfrm_state_lock);
- x = __find_acq_core(family, mode, reqid, proto, daddr, saddr, create);
- spin_unlock_bh(&xfrm_state_lock);
- return x;
- }
- EXPORT_SYMBOL(xfrm_find_acq);
- #ifdef CONFIG_XFRM_SUB_POLICY
- int
- xfrm_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n,
- unsigned short family)
- {
- int err = 0;
- struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
- if (!afinfo)
- return -EAFNOSUPPORT;
- spin_lock_bh(&xfrm_state_lock);
- if (afinfo->tmpl_sort)
- err = afinfo->tmpl_sort(dst, src, n);
- spin_unlock_bh(&xfrm_state_lock);
- xfrm_state_put_afinfo(afinfo);
- return err;
- }
- EXPORT_SYMBOL(xfrm_tmpl_sort);
- int
- xfrm_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n,
- unsigned short family)
- {
- int err = 0;
- struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
- if (!afinfo)
- return -EAFNOSUPPORT;
- spin_lock_bh(&xfrm_state_lock);
- if (afinfo->state_sort)
- err = afinfo->state_sort(dst, src, n);
- spin_unlock_bh(&xfrm_state_lock);
- xfrm_state_put_afinfo(afinfo);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_sort);
- #endif
- /* Silly enough, but I'm lazy to build resolution list */
- static struct xfrm_state *__xfrm_find_acq_byseq(u32 seq)
- {
- int i;
- for (i = 0; i <= xfrm_state_hmask; i++) {
- struct hlist_node *entry;
- struct xfrm_state *x;
- hlist_for_each_entry(x, entry, xfrm_state_bydst+i, bydst) {
- if (x->km.seq == seq &&
- x->km.state == XFRM_STATE_ACQ) {
- xfrm_state_hold(x);
- return x;
- }
- }
- }
- return NULL;
- }
- struct xfrm_state *xfrm_find_acq_byseq(u32 seq)
- {
- struct xfrm_state *x;
- spin_lock_bh(&xfrm_state_lock);
- x = __xfrm_find_acq_byseq(seq);
- spin_unlock_bh(&xfrm_state_lock);
- return x;
- }
- EXPORT_SYMBOL(xfrm_find_acq_byseq);
- u32 xfrm_get_acqseq(void)
- {
- u32 res;
- static u32 acqseq;
- static DEFINE_SPINLOCK(acqseq_lock);
- spin_lock_bh(&acqseq_lock);
- res = (++acqseq ? : ++acqseq);
- spin_unlock_bh(&acqseq_lock);
- return res;
- }
- EXPORT_SYMBOL(xfrm_get_acqseq);
- void
- xfrm_alloc_spi(struct xfrm_state *x, __be32 minspi, __be32 maxspi)
- {
- unsigned int h;
- struct xfrm_state *x0;
- if (x->id.spi)
- return;
- if (minspi == maxspi) {
- x0 = xfrm_state_lookup(&x->id.daddr, minspi, x->id.proto, x->props.family);
- if (x0) {
- xfrm_state_put(x0);
- return;
- }
- x->id.spi = minspi;
- } else {
- u32 spi = 0;
- u32 low = ntohl(minspi);
- u32 high = ntohl(maxspi);
- for (h=0; h<high-low+1; h++) {
- spi = low + net_random()%(high-low+1);
- x0 = xfrm_state_lookup(&x->id.daddr, htonl(spi), x->id.proto, x->props.family);
- if (x0 == NULL) {
- x->id.spi = htonl(spi);
- break;
- }
- xfrm_state_put(x0);
- }
- }
- if (x->id.spi) {
- spin_lock_bh(&xfrm_state_lock);
- h = xfrm_spi_hash(&x->id.daddr, x->id.spi, x->id.proto, x->props.family);
- hlist_add_head(&x->byspi, xfrm_state_byspi+h);
- spin_unlock_bh(&xfrm_state_lock);
- wake_up(&km_waitq);
- }
- }
- EXPORT_SYMBOL(xfrm_alloc_spi);
- int xfrm_state_walk(u8 proto, int (*func)(struct xfrm_state *, int, void*),
- void *data)
- {
- int i;
- struct xfrm_state *x;
- struct hlist_node *entry;
- int count = 0;
- int err = 0;
- spin_lock_bh(&xfrm_state_lock);
- for (i = 0; i <= xfrm_state_hmask; i++) {
- hlist_for_each_entry(x, entry, xfrm_state_bydst+i, bydst) {
- if (xfrm_id_proto_match(x->id.proto, proto))
- count++;
- }
- }
- if (count == 0) {
- err = -ENOENT;
- goto out;
- }
- for (i = 0; i <= xfrm_state_hmask; i++) {
- hlist_for_each_entry(x, entry, xfrm_state_bydst+i, bydst) {
- if (!xfrm_id_proto_match(x->id.proto, proto))
- continue;
- err = func(x, --count, data);
- if (err)
- goto out;
- }
- }
- out:
- spin_unlock_bh(&xfrm_state_lock);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_walk);
- void xfrm_replay_notify(struct xfrm_state *x, int event)
- {
- struct km_event c;
- /* we send notify messages in case
- * 1. we updated on of the sequence numbers, and the seqno difference
- * is at least x->replay_maxdiff, in this case we also update the
- * timeout of our timer function
- * 2. if x->replay_maxage has elapsed since last update,
- * and there were changes
- *
- * The state structure must be locked!
- */
- switch (event) {
- case XFRM_REPLAY_UPDATE:
- if (x->replay_maxdiff &&
- (x->replay.seq - x->preplay.seq < x->replay_maxdiff) &&
- (x->replay.oseq - x->preplay.oseq < x->replay_maxdiff)) {
- if (x->xflags & XFRM_TIME_DEFER)
- event = XFRM_REPLAY_TIMEOUT;
- else
- return;
- }
- break;
- case XFRM_REPLAY_TIMEOUT:
- if ((x->replay.seq == x->preplay.seq) &&
- (x->replay.bitmap == x->preplay.bitmap) &&
- (x->replay.oseq == x->preplay.oseq)) {
- x->xflags |= XFRM_TIME_DEFER;
- return;
- }
- break;
- }
- memcpy(&x->preplay, &x->replay, sizeof(struct xfrm_replay_state));
- c.event = XFRM_MSG_NEWAE;
- c.data.aevent = event;
- km_state_notify(x, &c);
- if (x->replay_maxage &&
- !mod_timer(&x->rtimer, jiffies + x->replay_maxage))
- x->xflags &= ~XFRM_TIME_DEFER;
- }
- EXPORT_SYMBOL(xfrm_replay_notify);
- static void xfrm_replay_timer_handler(unsigned long data)
- {
- struct xfrm_state *x = (struct xfrm_state*)data;
- spin_lock(&x->lock);
- if (x->km.state == XFRM_STATE_VALID) {
- if (xfrm_aevent_is_on())
- xfrm_replay_notify(x, XFRM_REPLAY_TIMEOUT);
- else
- x->xflags |= XFRM_TIME_DEFER;
- }
- spin_unlock(&x->lock);
- }
- int xfrm_replay_check(struct xfrm_state *x, __be32 net_seq)
- {
- u32 diff;
- u32 seq = ntohl(net_seq);
- if (unlikely(seq == 0))
- return -EINVAL;
- if (likely(seq > x->replay.seq))
- return 0;
- diff = x->replay.seq - seq;
- if (diff >= x->props.replay_window) {
- x->stats.replay_window++;
- return -EINVAL;
- }
- if (x->replay.bitmap & (1U << diff)) {
- x->stats.replay++;
- return -EINVAL;
- }
- return 0;
- }
- EXPORT_SYMBOL(xfrm_replay_check);
- void xfrm_replay_advance(struct xfrm_state *x, __be32 net_seq)
- {
- u32 diff;
- u32 seq = ntohl(net_seq);
- if (seq > x->replay.seq) {
- diff = seq - x->replay.seq;
- if (diff < x->props.replay_window)
- x->replay.bitmap = ((x->replay.bitmap) << diff) | 1;
- else
- x->replay.bitmap = 1;
- x->replay.seq = seq;
- } else {
- diff = x->replay.seq - seq;
- x->replay.bitmap |= (1U << diff);
- }
- if (xfrm_aevent_is_on())
- xfrm_replay_notify(x, XFRM_REPLAY_UPDATE);
- }
- EXPORT_SYMBOL(xfrm_replay_advance);
- static struct list_head xfrm_km_list = LIST_HEAD_INIT(xfrm_km_list);
- static DEFINE_RWLOCK(xfrm_km_lock);
- void km_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
- {
- struct xfrm_mgr *km;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list)
- if (km->notify_policy)
- km->notify_policy(xp, dir, c);
- read_unlock(&xfrm_km_lock);
- }
- void km_state_notify(struct xfrm_state *x, struct km_event *c)
- {
- struct xfrm_mgr *km;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list)
- if (km->notify)
- km->notify(x, c);
- read_unlock(&xfrm_km_lock);
- }
- EXPORT_SYMBOL(km_policy_notify);
- EXPORT_SYMBOL(km_state_notify);
- void km_state_expired(struct xfrm_state *x, int hard, u32 pid)
- {
- struct km_event c;
- c.data.hard = hard;
- c.pid = pid;
- c.event = XFRM_MSG_EXPIRE;
- km_state_notify(x, &c);
- if (hard)
- wake_up(&km_waitq);
- }
- EXPORT_SYMBOL(km_state_expired);
- /*
- * We send to all registered managers regardless of failure
- * We are happy with one success
- */
- int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol)
- {
- int err = -EINVAL, acqret;
- struct xfrm_mgr *km;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list) {
- acqret = km->acquire(x, t, pol, XFRM_POLICY_OUT);
- if (!acqret)
- err = acqret;
- }
- read_unlock(&xfrm_km_lock);
- return err;
- }
- EXPORT_SYMBOL(km_query);
- int km_new_mapping(struct xfrm_state *x, xfrm_address_t *ipaddr, u16 sport)
- {
- int err = -EINVAL;
- struct xfrm_mgr *km;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list) {
- if (km->new_mapping)
- err = km->new_mapping(x, ipaddr, sport);
- if (!err)
- break;
- }
- read_unlock(&xfrm_km_lock);
- return err;
- }
- EXPORT_SYMBOL(km_new_mapping);
- void km_policy_expired(struct xfrm_policy *pol, int dir, int hard, u32 pid)
- {
- struct km_event c;
- c.data.hard = hard;
- c.pid = pid;
- c.event = XFRM_MSG_POLEXPIRE;
- km_policy_notify(pol, dir, &c);
- if (hard)
- wake_up(&km_waitq);
- }
- EXPORT_SYMBOL(km_policy_expired);
- int km_report(u8 proto, struct xfrm_selector *sel, xfrm_address_t *addr)
- {
- int err = -EINVAL;
- int ret;
- struct xfrm_mgr *km;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list) {
- if (km->report) {
- ret = km->report(proto, sel, addr);
- if (!ret)
- err = ret;
- }
- }
- read_unlock(&xfrm_km_lock);
- return err;
- }
- EXPORT_SYMBOL(km_report);
- int xfrm_user_policy(struct sock *sk, int optname, u8 __user *optval, int optlen)
- {
- int err;
- u8 *data;
- struct xfrm_mgr *km;
- struct xfrm_policy *pol = NULL;
- if (optlen <= 0 || optlen > PAGE_SIZE)
- return -EMSGSIZE;
- data = kmalloc(optlen, GFP_KERNEL);
- if (!data)
- return -ENOMEM;
- err = -EFAULT;
- if (copy_from_user(data, optval, optlen))
- goto out;
- err = -EINVAL;
- read_lock(&xfrm_km_lock);
- list_for_each_entry(km, &xfrm_km_list, list) {
- pol = km->compile_policy(sk, optname, data,
- optlen, &err);
- if (err >= 0)
- break;
- }
- read_unlock(&xfrm_km_lock);
- if (err >= 0) {
- xfrm_sk_policy_insert(sk, err, pol);
- xfrm_pol_put(pol);
- err = 0;
- }
- out:
- kfree(data);
- return err;
- }
- EXPORT_SYMBOL(xfrm_user_policy);
- int xfrm_register_km(struct xfrm_mgr *km)
- {
- write_lock_bh(&xfrm_km_lock);
- list_add_tail(&km->list, &xfrm_km_list);
- write_unlock_bh(&xfrm_km_lock);
- return 0;
- }
- EXPORT_SYMBOL(xfrm_register_km);
- int xfrm_unregister_km(struct xfrm_mgr *km)
- {
- write_lock_bh(&xfrm_km_lock);
- list_del(&km->list);
- write_unlock_bh(&xfrm_km_lock);
- return 0;
- }
- EXPORT_SYMBOL(xfrm_unregister_km);
- int xfrm_state_register_afinfo(struct xfrm_state_afinfo *afinfo)
- {
- int err = 0;
- if (unlikely(afinfo == NULL))
- return -EINVAL;
- if (unlikely(afinfo->family >= NPROTO))
- return -EAFNOSUPPORT;
- write_lock_bh(&xfrm_state_afinfo_lock);
- if (unlikely(xfrm_state_afinfo[afinfo->family] != NULL))
- err = -ENOBUFS;
- else
- xfrm_state_afinfo[afinfo->family] = afinfo;
- write_unlock_bh(&xfrm_state_afinfo_lock);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_register_afinfo);
- int xfrm_state_unregister_afinfo(struct xfrm_state_afinfo *afinfo)
- {
- int err = 0;
- if (unlikely(afinfo == NULL))
- return -EINVAL;
- if (unlikely(afinfo->family >= NPROTO))
- return -EAFNOSUPPORT;
- write_lock_bh(&xfrm_state_afinfo_lock);
- if (likely(xfrm_state_afinfo[afinfo->family] != NULL)) {
- if (unlikely(xfrm_state_afinfo[afinfo->family] != afinfo))
- err = -EINVAL;
- else
- xfrm_state_afinfo[afinfo->family] = NULL;
- }
- write_unlock_bh(&xfrm_state_afinfo_lock);
- return err;
- }
- EXPORT_SYMBOL(xfrm_state_unregister_afinfo);
- static struct xfrm_state_afinfo *xfrm_state_get_afinfo(unsigned short family)
- {
- struct xfrm_state_afinfo *afinfo;
- if (unlikely(family >= NPROTO))
- return NULL;
- read_lock(&xfrm_state_afinfo_lock);
- afinfo = xfrm_state_afinfo[family];
- if (unlikely(!afinfo))
- read_unlock(&xfrm_state_afinfo_lock);
- return afinfo;
- }
- static void xfrm_state_put_afinfo(struct xfrm_state_afinfo *afinfo)
- {
- read_unlock(&xfrm_state_afinfo_lock);
- }
- /* Temporarily located here until net/xfrm/xfrm_tunnel.c is created */
- void xfrm_state_delete_tunnel(struct xfrm_state *x)
- {
- if (x->tunnel) {
- struct xfrm_state *t = x->tunnel;
- if (atomic_read(&t->tunnel_users) == 2)
- xfrm_state_delete(t);
- atomic_dec(&t->tunnel_users);
- xfrm_state_put(t);
- x->tunnel = NULL;
- }
- }
- EXPORT_SYMBOL(xfrm_state_delete_tunnel);
- /*
- * This function is NOT optimal. For example, with ESP it will give an
- * MTU that's usually two bytes short of being optimal. However, it will
- * usually give an answer that's a multiple of 4 provided the input is
- * also a multiple of 4.
- */
- int xfrm_state_mtu(struct xfrm_state *x, int mtu)
- {
- int res = mtu;
- res -= x->props.header_len;
- for (;;) {
- int m = res;
- if (m < 68)
- return 68;
- spin_lock_bh(&x->lock);
- if (x->km.state == XFRM_STATE_VALID &&
- x->type && x->type->get_max_size)
- m = x->type->get_max_size(x, m);
- else
- m += x->props.header_len;
- spin_unlock_bh(&x->lock);
- if (m <= mtu)
- break;
- res -= (m - mtu);
- }
- return res;
- }
- int xfrm_init_state(struct xfrm_state *x)
- {
- struct xfrm_state_afinfo *afinfo;
- int family = x->props.family;
- int err;
- err = -EAFNOSUPPORT;
- afinfo = xfrm_state_get_afinfo(family);
- if (!afinfo)
- goto error;
- err = 0;
- if (afinfo->init_flags)
- err = afinfo->init_flags(x);
- xfrm_state_put_afinfo(afinfo);
- if (err)
- goto error;
- err = -EPROTONOSUPPORT;
- x->type = xfrm_get_type(x->id.proto, family);
- if (x->type == NULL)
- goto error;
- err = x->type->init_state(x);
- if (err)
- goto error;
- x->mode = xfrm_get_mode(x->props.mode, family);
- if (x->mode == NULL)
- goto error;
- x->km.state = XFRM_STATE_VALID;
- error:
- return err;
- }
- EXPORT_SYMBOL(xfrm_init_state);
-
- void __init xfrm_state_init(void)
- {
- unsigned int sz;
- sz = sizeof(struct hlist_head) * 8;
- xfrm_state_bydst = xfrm_hash_alloc(sz);
- xfrm_state_bysrc = xfrm_hash_alloc(sz);
- xfrm_state_byspi = xfrm_hash_alloc(sz);
- if (!xfrm_state_bydst || !xfrm_state_bysrc || !xfrm_state_byspi)
- panic("XFRM: Cannot allocate bydst/bysrc/byspi hashes.");
- xfrm_state_hmask = ((sz / sizeof(struct hlist_head)) - 1);
- INIT_WORK(&xfrm_state_gc_work, xfrm_state_gc_task, NULL);
- }
|