12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559 |
- /*
- * 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, u32 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);
- 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, u32 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 (xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY)) {
- 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, u32 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, u32 minspi, u32 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;
- minspi = ntohl(minspi);
- maxspi = ntohl(maxspi);
- for (h=0; h<maxspi-minspi+1; h++) {
- spi = minspi + net_random()%(maxspi-minspi+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, u32 seq)
- {
- u32 diff;
- seq = ntohl(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, u32 seq)
- {
- u32 diff;
- seq = ntohl(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);
- }
|