datapath.c 57 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382
  1. /*
  2. * Copyright (c) 2007-2014 Nicira, Inc.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of version 2 of the GNU General Public
  6. * License as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful, but
  9. * WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  11. * General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program; if not, write to the Free Software
  15. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  16. * 02110-1301, USA
  17. */
  18. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  19. #include <linux/init.h>
  20. #include <linux/module.h>
  21. #include <linux/if_arp.h>
  22. #include <linux/if_vlan.h>
  23. #include <linux/in.h>
  24. #include <linux/ip.h>
  25. #include <linux/jhash.h>
  26. #include <linux/delay.h>
  27. #include <linux/time.h>
  28. #include <linux/etherdevice.h>
  29. #include <linux/genetlink.h>
  30. #include <linux/kernel.h>
  31. #include <linux/kthread.h>
  32. #include <linux/mutex.h>
  33. #include <linux/percpu.h>
  34. #include <linux/rcupdate.h>
  35. #include <linux/tcp.h>
  36. #include <linux/udp.h>
  37. #include <linux/ethtool.h>
  38. #include <linux/wait.h>
  39. #include <asm/div64.h>
  40. #include <linux/highmem.h>
  41. #include <linux/netfilter_bridge.h>
  42. #include <linux/netfilter_ipv4.h>
  43. #include <linux/inetdevice.h>
  44. #include <linux/list.h>
  45. #include <linux/openvswitch.h>
  46. #include <linux/rculist.h>
  47. #include <linux/dmi.h>
  48. #include <net/genetlink.h>
  49. #include <net/net_namespace.h>
  50. #include <net/netns/generic.h>
  51. #include "datapath.h"
  52. #include "flow.h"
  53. #include "flow_table.h"
  54. #include "flow_netlink.h"
  55. #include "vport-internal_dev.h"
  56. #include "vport-netdev.h"
  57. int ovs_net_id __read_mostly;
  58. EXPORT_SYMBOL_GPL(ovs_net_id);
  59. static struct genl_family dp_packet_genl_family;
  60. static struct genl_family dp_flow_genl_family;
  61. static struct genl_family dp_datapath_genl_family;
  62. static const struct nla_policy flow_policy[];
  63. static const struct genl_multicast_group ovs_dp_flow_multicast_group = {
  64. .name = OVS_FLOW_MCGROUP,
  65. };
  66. static const struct genl_multicast_group ovs_dp_datapath_multicast_group = {
  67. .name = OVS_DATAPATH_MCGROUP,
  68. };
  69. static const struct genl_multicast_group ovs_dp_vport_multicast_group = {
  70. .name = OVS_VPORT_MCGROUP,
  71. };
  72. /* Check if need to build a reply message.
  73. * OVS userspace sets the NLM_F_ECHO flag if it needs the reply. */
  74. static bool ovs_must_notify(struct genl_family *family, struct genl_info *info,
  75. unsigned int group)
  76. {
  77. return info->nlhdr->nlmsg_flags & NLM_F_ECHO ||
  78. genl_has_listeners(family, genl_info_net(info), group);
  79. }
  80. static void ovs_notify(struct genl_family *family,
  81. struct sk_buff *skb, struct genl_info *info)
  82. {
  83. genl_notify(family, skb, genl_info_net(info), info->snd_portid,
  84. 0, info->nlhdr, GFP_KERNEL);
  85. }
  86. /**
  87. * DOC: Locking:
  88. *
  89. * All writes e.g. Writes to device state (add/remove datapath, port, set
  90. * operations on vports, etc.), Writes to other state (flow table
  91. * modifications, set miscellaneous datapath parameters, etc.) are protected
  92. * by ovs_lock.
  93. *
  94. * Reads are protected by RCU.
  95. *
  96. * There are a few special cases (mostly stats) that have their own
  97. * synchronization but they nest under all of above and don't interact with
  98. * each other.
  99. *
  100. * The RTNL lock nests inside ovs_mutex.
  101. */
  102. static DEFINE_MUTEX(ovs_mutex);
  103. void ovs_lock(void)
  104. {
  105. mutex_lock(&ovs_mutex);
  106. }
  107. void ovs_unlock(void)
  108. {
  109. mutex_unlock(&ovs_mutex);
  110. }
  111. #ifdef CONFIG_LOCKDEP
  112. int lockdep_ovsl_is_held(void)
  113. {
  114. if (debug_locks)
  115. return lockdep_is_held(&ovs_mutex);
  116. else
  117. return 1;
  118. }
  119. EXPORT_SYMBOL_GPL(lockdep_ovsl_is_held);
  120. #endif
  121. static struct vport *new_vport(const struct vport_parms *);
  122. static int queue_gso_packets(struct datapath *dp, struct sk_buff *,
  123. const struct sw_flow_key *,
  124. const struct dp_upcall_info *);
  125. static int queue_userspace_packet(struct datapath *dp, struct sk_buff *,
  126. const struct sw_flow_key *,
  127. const struct dp_upcall_info *);
  128. /* Must be called with rcu_read_lock. */
  129. static struct datapath *get_dp_rcu(struct net *net, int dp_ifindex)
  130. {
  131. struct net_device *dev = dev_get_by_index_rcu(net, dp_ifindex);
  132. if (dev) {
  133. struct vport *vport = ovs_internal_dev_get_vport(dev);
  134. if (vport)
  135. return vport->dp;
  136. }
  137. return NULL;
  138. }
  139. /* The caller must hold either ovs_mutex or rcu_read_lock to keep the
  140. * returned dp pointer valid.
  141. */
  142. static inline struct datapath *get_dp(struct net *net, int dp_ifindex)
  143. {
  144. struct datapath *dp;
  145. WARN_ON_ONCE(!rcu_read_lock_held() && !lockdep_ovsl_is_held());
  146. rcu_read_lock();
  147. dp = get_dp_rcu(net, dp_ifindex);
  148. rcu_read_unlock();
  149. return dp;
  150. }
  151. /* Must be called with rcu_read_lock or ovs_mutex. */
  152. const char *ovs_dp_name(const struct datapath *dp)
  153. {
  154. struct vport *vport = ovs_vport_ovsl_rcu(dp, OVSP_LOCAL);
  155. return ovs_vport_name(vport);
  156. }
  157. static int get_dpifindex(const struct datapath *dp)
  158. {
  159. struct vport *local;
  160. int ifindex;
  161. rcu_read_lock();
  162. local = ovs_vport_rcu(dp, OVSP_LOCAL);
  163. if (local)
  164. ifindex = local->dev->ifindex;
  165. else
  166. ifindex = 0;
  167. rcu_read_unlock();
  168. return ifindex;
  169. }
  170. static void destroy_dp_rcu(struct rcu_head *rcu)
  171. {
  172. struct datapath *dp = container_of(rcu, struct datapath, rcu);
  173. ovs_flow_tbl_destroy(&dp->table);
  174. free_percpu(dp->stats_percpu);
  175. kfree(dp->ports);
  176. kfree(dp);
  177. }
  178. static struct hlist_head *vport_hash_bucket(const struct datapath *dp,
  179. u16 port_no)
  180. {
  181. return &dp->ports[port_no & (DP_VPORT_HASH_BUCKETS - 1)];
  182. }
  183. /* Called with ovs_mutex or RCU read lock. */
  184. struct vport *ovs_lookup_vport(const struct datapath *dp, u16 port_no)
  185. {
  186. struct vport *vport;
  187. struct hlist_head *head;
  188. head = vport_hash_bucket(dp, port_no);
  189. hlist_for_each_entry_rcu(vport, head, dp_hash_node) {
  190. if (vport->port_no == port_no)
  191. return vport;
  192. }
  193. return NULL;
  194. }
  195. /* Called with ovs_mutex. */
  196. static struct vport *new_vport(const struct vport_parms *parms)
  197. {
  198. struct vport *vport;
  199. vport = ovs_vport_add(parms);
  200. if (!IS_ERR(vport)) {
  201. struct datapath *dp = parms->dp;
  202. struct hlist_head *head = vport_hash_bucket(dp, vport->port_no);
  203. hlist_add_head_rcu(&vport->dp_hash_node, head);
  204. }
  205. return vport;
  206. }
  207. void ovs_dp_detach_port(struct vport *p)
  208. {
  209. ASSERT_OVSL();
  210. /* First drop references to device. */
  211. hlist_del_rcu(&p->dp_hash_node);
  212. /* Then destroy it. */
  213. ovs_vport_del(p);
  214. }
  215. /* Must be called with rcu_read_lock. */
  216. void ovs_dp_process_packet(struct sk_buff *skb, struct sw_flow_key *key)
  217. {
  218. const struct vport *p = OVS_CB(skb)->input_vport;
  219. struct datapath *dp = p->dp;
  220. struct sw_flow *flow;
  221. struct sw_flow_actions *sf_acts;
  222. struct dp_stats_percpu *stats;
  223. u64 *stats_counter;
  224. u32 n_mask_hit;
  225. stats = this_cpu_ptr(dp->stats_percpu);
  226. /* Look up flow. */
  227. flow = ovs_flow_tbl_lookup_stats(&dp->table, key, &n_mask_hit);
  228. if (unlikely(!flow)) {
  229. struct dp_upcall_info upcall;
  230. int error;
  231. memset(&upcall, 0, sizeof(upcall));
  232. upcall.cmd = OVS_PACKET_CMD_MISS;
  233. upcall.portid = ovs_vport_find_upcall_portid(p, skb);
  234. upcall.mru = OVS_CB(skb)->mru;
  235. error = ovs_dp_upcall(dp, skb, key, &upcall);
  236. if (unlikely(error))
  237. kfree_skb(skb);
  238. else
  239. consume_skb(skb);
  240. stats_counter = &stats->n_missed;
  241. goto out;
  242. }
  243. ovs_flow_stats_update(flow, key->tp.flags, skb);
  244. sf_acts = rcu_dereference(flow->sf_acts);
  245. ovs_execute_actions(dp, skb, sf_acts, key);
  246. stats_counter = &stats->n_hit;
  247. out:
  248. /* Update datapath statistics. */
  249. u64_stats_update_begin(&stats->syncp);
  250. (*stats_counter)++;
  251. stats->n_mask_hit += n_mask_hit;
  252. u64_stats_update_end(&stats->syncp);
  253. }
  254. int ovs_dp_upcall(struct datapath *dp, struct sk_buff *skb,
  255. const struct sw_flow_key *key,
  256. const struct dp_upcall_info *upcall_info)
  257. {
  258. struct dp_stats_percpu *stats;
  259. int err;
  260. if (upcall_info->portid == 0) {
  261. err = -ENOTCONN;
  262. goto err;
  263. }
  264. if (!skb_is_gso(skb))
  265. err = queue_userspace_packet(dp, skb, key, upcall_info);
  266. else
  267. err = queue_gso_packets(dp, skb, key, upcall_info);
  268. if (err)
  269. goto err;
  270. return 0;
  271. err:
  272. stats = this_cpu_ptr(dp->stats_percpu);
  273. u64_stats_update_begin(&stats->syncp);
  274. stats->n_lost++;
  275. u64_stats_update_end(&stats->syncp);
  276. return err;
  277. }
  278. static int queue_gso_packets(struct datapath *dp, struct sk_buff *skb,
  279. const struct sw_flow_key *key,
  280. const struct dp_upcall_info *upcall_info)
  281. {
  282. unsigned short gso_type = skb_shinfo(skb)->gso_type;
  283. struct sw_flow_key later_key;
  284. struct sk_buff *segs, *nskb;
  285. struct ovs_skb_cb ovs_cb;
  286. int err;
  287. ovs_cb = *OVS_CB(skb);
  288. segs = __skb_gso_segment(skb, NETIF_F_SG, false);
  289. *OVS_CB(skb) = ovs_cb;
  290. if (IS_ERR(segs))
  291. return PTR_ERR(segs);
  292. if (segs == NULL)
  293. return -EINVAL;
  294. if (gso_type & SKB_GSO_UDP) {
  295. /* The initial flow key extracted by ovs_flow_key_extract()
  296. * in this case is for a first fragment, so we need to
  297. * properly mark later fragments.
  298. */
  299. later_key = *key;
  300. later_key.ip.frag = OVS_FRAG_TYPE_LATER;
  301. }
  302. /* Queue all of the segments. */
  303. skb = segs;
  304. do {
  305. *OVS_CB(skb) = ovs_cb;
  306. if (gso_type & SKB_GSO_UDP && skb != segs)
  307. key = &later_key;
  308. err = queue_userspace_packet(dp, skb, key, upcall_info);
  309. if (err)
  310. break;
  311. } while ((skb = skb->next));
  312. /* Free all of the segments. */
  313. skb = segs;
  314. do {
  315. nskb = skb->next;
  316. if (err)
  317. kfree_skb(skb);
  318. else
  319. consume_skb(skb);
  320. } while ((skb = nskb));
  321. return err;
  322. }
  323. static size_t upcall_msg_size(const struct dp_upcall_info *upcall_info,
  324. unsigned int hdrlen)
  325. {
  326. size_t size = NLMSG_ALIGN(sizeof(struct ovs_header))
  327. + nla_total_size(hdrlen) /* OVS_PACKET_ATTR_PACKET */
  328. + nla_total_size(ovs_key_attr_size()); /* OVS_PACKET_ATTR_KEY */
  329. /* OVS_PACKET_ATTR_USERDATA */
  330. if (upcall_info->userdata)
  331. size += NLA_ALIGN(upcall_info->userdata->nla_len);
  332. /* OVS_PACKET_ATTR_EGRESS_TUN_KEY */
  333. if (upcall_info->egress_tun_info)
  334. size += nla_total_size(ovs_tun_key_attr_size());
  335. /* OVS_PACKET_ATTR_ACTIONS */
  336. if (upcall_info->actions_len)
  337. size += nla_total_size(upcall_info->actions_len);
  338. /* OVS_PACKET_ATTR_MRU */
  339. if (upcall_info->mru)
  340. size += nla_total_size(sizeof(upcall_info->mru));
  341. return size;
  342. }
  343. static void pad_packet(struct datapath *dp, struct sk_buff *skb)
  344. {
  345. if (!(dp->user_features & OVS_DP_F_UNALIGNED)) {
  346. size_t plen = NLA_ALIGN(skb->len) - skb->len;
  347. if (plen > 0)
  348. memset(skb_put(skb, plen), 0, plen);
  349. }
  350. }
  351. static int queue_userspace_packet(struct datapath *dp, struct sk_buff *skb,
  352. const struct sw_flow_key *key,
  353. const struct dp_upcall_info *upcall_info)
  354. {
  355. struct ovs_header *upcall;
  356. struct sk_buff *nskb = NULL;
  357. struct sk_buff *user_skb = NULL; /* to be queued to userspace */
  358. struct nlattr *nla;
  359. struct genl_info info = {
  360. .dst_sk = ovs_dp_get_net(dp)->genl_sock,
  361. .snd_portid = upcall_info->portid,
  362. };
  363. size_t len;
  364. unsigned int hlen;
  365. int err, dp_ifindex;
  366. dp_ifindex = get_dpifindex(dp);
  367. if (!dp_ifindex)
  368. return -ENODEV;
  369. if (skb_vlan_tag_present(skb)) {
  370. nskb = skb_clone(skb, GFP_ATOMIC);
  371. if (!nskb)
  372. return -ENOMEM;
  373. nskb = __vlan_hwaccel_push_inside(nskb);
  374. if (!nskb)
  375. return -ENOMEM;
  376. skb = nskb;
  377. }
  378. if (nla_attr_size(skb->len) > USHRT_MAX) {
  379. err = -EFBIG;
  380. goto out;
  381. }
  382. /* Complete checksum if needed */
  383. if (skb->ip_summed == CHECKSUM_PARTIAL &&
  384. (err = skb_checksum_help(skb)))
  385. goto out;
  386. /* Older versions of OVS user space enforce alignment of the last
  387. * Netlink attribute to NLA_ALIGNTO which would require extensive
  388. * padding logic. Only perform zerocopy if padding is not required.
  389. */
  390. if (dp->user_features & OVS_DP_F_UNALIGNED)
  391. hlen = skb_zerocopy_headlen(skb);
  392. else
  393. hlen = skb->len;
  394. len = upcall_msg_size(upcall_info, hlen);
  395. user_skb = genlmsg_new_unicast(len, &info, GFP_ATOMIC);
  396. if (!user_skb) {
  397. err = -ENOMEM;
  398. goto out;
  399. }
  400. upcall = genlmsg_put(user_skb, 0, 0, &dp_packet_genl_family,
  401. 0, upcall_info->cmd);
  402. upcall->dp_ifindex = dp_ifindex;
  403. err = ovs_nla_put_key(key, key, OVS_PACKET_ATTR_KEY, false, user_skb);
  404. BUG_ON(err);
  405. if (upcall_info->userdata)
  406. __nla_put(user_skb, OVS_PACKET_ATTR_USERDATA,
  407. nla_len(upcall_info->userdata),
  408. nla_data(upcall_info->userdata));
  409. if (upcall_info->egress_tun_info) {
  410. nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_EGRESS_TUN_KEY);
  411. err = ovs_nla_put_egress_tunnel_key(user_skb,
  412. upcall_info->egress_tun_info);
  413. BUG_ON(err);
  414. nla_nest_end(user_skb, nla);
  415. }
  416. if (upcall_info->actions_len) {
  417. nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_ACTIONS);
  418. err = ovs_nla_put_actions(upcall_info->actions,
  419. upcall_info->actions_len,
  420. user_skb);
  421. if (!err)
  422. nla_nest_end(user_skb, nla);
  423. else
  424. nla_nest_cancel(user_skb, nla);
  425. }
  426. /* Add OVS_PACKET_ATTR_MRU */
  427. if (upcall_info->mru) {
  428. if (nla_put_u16(user_skb, OVS_PACKET_ATTR_MRU,
  429. upcall_info->mru)) {
  430. err = -ENOBUFS;
  431. goto out;
  432. }
  433. pad_packet(dp, user_skb);
  434. }
  435. /* Only reserve room for attribute header, packet data is added
  436. * in skb_zerocopy() */
  437. if (!(nla = nla_reserve(user_skb, OVS_PACKET_ATTR_PACKET, 0))) {
  438. err = -ENOBUFS;
  439. goto out;
  440. }
  441. nla->nla_len = nla_attr_size(skb->len);
  442. err = skb_zerocopy(user_skb, skb, skb->len, hlen);
  443. if (err)
  444. goto out;
  445. /* Pad OVS_PACKET_ATTR_PACKET if linear copy was performed */
  446. pad_packet(dp, user_skb);
  447. ((struct nlmsghdr *) user_skb->data)->nlmsg_len = user_skb->len;
  448. err = genlmsg_unicast(ovs_dp_get_net(dp), user_skb, upcall_info->portid);
  449. user_skb = NULL;
  450. out:
  451. if (err)
  452. skb_tx_error(skb);
  453. kfree_skb(user_skb);
  454. kfree_skb(nskb);
  455. return err;
  456. }
  457. static int ovs_packet_cmd_execute(struct sk_buff *skb, struct genl_info *info)
  458. {
  459. struct ovs_header *ovs_header = info->userhdr;
  460. struct net *net = sock_net(skb->sk);
  461. struct nlattr **a = info->attrs;
  462. struct sw_flow_actions *acts;
  463. struct sk_buff *packet;
  464. struct sw_flow *flow;
  465. struct sw_flow_actions *sf_acts;
  466. struct datapath *dp;
  467. struct ethhdr *eth;
  468. struct vport *input_vport;
  469. u16 mru = 0;
  470. int len;
  471. int err;
  472. bool log = !a[OVS_PACKET_ATTR_PROBE];
  473. err = -EINVAL;
  474. if (!a[OVS_PACKET_ATTR_PACKET] || !a[OVS_PACKET_ATTR_KEY] ||
  475. !a[OVS_PACKET_ATTR_ACTIONS])
  476. goto err;
  477. len = nla_len(a[OVS_PACKET_ATTR_PACKET]);
  478. packet = __dev_alloc_skb(NET_IP_ALIGN + len, GFP_KERNEL);
  479. err = -ENOMEM;
  480. if (!packet)
  481. goto err;
  482. skb_reserve(packet, NET_IP_ALIGN);
  483. nla_memcpy(__skb_put(packet, len), a[OVS_PACKET_ATTR_PACKET], len);
  484. skb_reset_mac_header(packet);
  485. eth = eth_hdr(packet);
  486. /* Normally, setting the skb 'protocol' field would be handled by a
  487. * call to eth_type_trans(), but it assumes there's a sending
  488. * device, which we may not have. */
  489. if (eth_proto_is_802_3(eth->h_proto))
  490. packet->protocol = eth->h_proto;
  491. else
  492. packet->protocol = htons(ETH_P_802_2);
  493. /* Set packet's mru */
  494. if (a[OVS_PACKET_ATTR_MRU]) {
  495. mru = nla_get_u16(a[OVS_PACKET_ATTR_MRU]);
  496. packet->ignore_df = 1;
  497. }
  498. OVS_CB(packet)->mru = mru;
  499. /* Build an sw_flow for sending this packet. */
  500. flow = ovs_flow_alloc();
  501. err = PTR_ERR(flow);
  502. if (IS_ERR(flow))
  503. goto err_kfree_skb;
  504. err = ovs_flow_key_extract_userspace(net, a[OVS_PACKET_ATTR_KEY],
  505. packet, &flow->key, log);
  506. if (err)
  507. goto err_flow_free;
  508. err = ovs_nla_copy_actions(net, a[OVS_PACKET_ATTR_ACTIONS],
  509. &flow->key, &acts, log);
  510. if (err)
  511. goto err_flow_free;
  512. rcu_assign_pointer(flow->sf_acts, acts);
  513. OVS_CB(packet)->egress_tun_info = NULL;
  514. packet->priority = flow->key.phy.priority;
  515. packet->mark = flow->key.phy.skb_mark;
  516. rcu_read_lock();
  517. dp = get_dp_rcu(net, ovs_header->dp_ifindex);
  518. err = -ENODEV;
  519. if (!dp)
  520. goto err_unlock;
  521. input_vport = ovs_vport_rcu(dp, flow->key.phy.in_port);
  522. if (!input_vport)
  523. input_vport = ovs_vport_rcu(dp, OVSP_LOCAL);
  524. if (!input_vport)
  525. goto err_unlock;
  526. packet->dev = input_vport->dev;
  527. OVS_CB(packet)->input_vport = input_vport;
  528. sf_acts = rcu_dereference(flow->sf_acts);
  529. local_bh_disable();
  530. err = ovs_execute_actions(dp, packet, sf_acts, &flow->key);
  531. local_bh_enable();
  532. rcu_read_unlock();
  533. ovs_flow_free(flow, false);
  534. return err;
  535. err_unlock:
  536. rcu_read_unlock();
  537. err_flow_free:
  538. ovs_flow_free(flow, false);
  539. err_kfree_skb:
  540. kfree_skb(packet);
  541. err:
  542. return err;
  543. }
  544. static const struct nla_policy packet_policy[OVS_PACKET_ATTR_MAX + 1] = {
  545. [OVS_PACKET_ATTR_PACKET] = { .len = ETH_HLEN },
  546. [OVS_PACKET_ATTR_KEY] = { .type = NLA_NESTED },
  547. [OVS_PACKET_ATTR_ACTIONS] = { .type = NLA_NESTED },
  548. [OVS_PACKET_ATTR_PROBE] = { .type = NLA_FLAG },
  549. [OVS_PACKET_ATTR_MRU] = { .type = NLA_U16 },
  550. };
  551. static const struct genl_ops dp_packet_genl_ops[] = {
  552. { .cmd = OVS_PACKET_CMD_EXECUTE,
  553. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  554. .policy = packet_policy,
  555. .doit = ovs_packet_cmd_execute
  556. }
  557. };
  558. static struct genl_family dp_packet_genl_family = {
  559. .id = GENL_ID_GENERATE,
  560. .hdrsize = sizeof(struct ovs_header),
  561. .name = OVS_PACKET_FAMILY,
  562. .version = OVS_PACKET_VERSION,
  563. .maxattr = OVS_PACKET_ATTR_MAX,
  564. .netnsok = true,
  565. .parallel_ops = true,
  566. .ops = dp_packet_genl_ops,
  567. .n_ops = ARRAY_SIZE(dp_packet_genl_ops),
  568. };
  569. static void get_dp_stats(const struct datapath *dp, struct ovs_dp_stats *stats,
  570. struct ovs_dp_megaflow_stats *mega_stats)
  571. {
  572. int i;
  573. memset(mega_stats, 0, sizeof(*mega_stats));
  574. stats->n_flows = ovs_flow_tbl_count(&dp->table);
  575. mega_stats->n_masks = ovs_flow_tbl_num_masks(&dp->table);
  576. stats->n_hit = stats->n_missed = stats->n_lost = 0;
  577. for_each_possible_cpu(i) {
  578. const struct dp_stats_percpu *percpu_stats;
  579. struct dp_stats_percpu local_stats;
  580. unsigned int start;
  581. percpu_stats = per_cpu_ptr(dp->stats_percpu, i);
  582. do {
  583. start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
  584. local_stats = *percpu_stats;
  585. } while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
  586. stats->n_hit += local_stats.n_hit;
  587. stats->n_missed += local_stats.n_missed;
  588. stats->n_lost += local_stats.n_lost;
  589. mega_stats->n_mask_hit += local_stats.n_mask_hit;
  590. }
  591. }
  592. static bool should_fill_key(const struct sw_flow_id *sfid, uint32_t ufid_flags)
  593. {
  594. return ovs_identifier_is_ufid(sfid) &&
  595. !(ufid_flags & OVS_UFID_F_OMIT_KEY);
  596. }
  597. static bool should_fill_mask(uint32_t ufid_flags)
  598. {
  599. return !(ufid_flags & OVS_UFID_F_OMIT_MASK);
  600. }
  601. static bool should_fill_actions(uint32_t ufid_flags)
  602. {
  603. return !(ufid_flags & OVS_UFID_F_OMIT_ACTIONS);
  604. }
  605. static size_t ovs_flow_cmd_msg_size(const struct sw_flow_actions *acts,
  606. const struct sw_flow_id *sfid,
  607. uint32_t ufid_flags)
  608. {
  609. size_t len = NLMSG_ALIGN(sizeof(struct ovs_header));
  610. /* OVS_FLOW_ATTR_UFID */
  611. if (sfid && ovs_identifier_is_ufid(sfid))
  612. len += nla_total_size(sfid->ufid_len);
  613. /* OVS_FLOW_ATTR_KEY */
  614. if (!sfid || should_fill_key(sfid, ufid_flags))
  615. len += nla_total_size(ovs_key_attr_size());
  616. /* OVS_FLOW_ATTR_MASK */
  617. if (should_fill_mask(ufid_flags))
  618. len += nla_total_size(ovs_key_attr_size());
  619. /* OVS_FLOW_ATTR_ACTIONS */
  620. if (should_fill_actions(ufid_flags))
  621. len += nla_total_size(acts->orig_len);
  622. return len
  623. + nla_total_size(sizeof(struct ovs_flow_stats)) /* OVS_FLOW_ATTR_STATS */
  624. + nla_total_size(1) /* OVS_FLOW_ATTR_TCP_FLAGS */
  625. + nla_total_size(8); /* OVS_FLOW_ATTR_USED */
  626. }
  627. /* Called with ovs_mutex or RCU read lock. */
  628. static int ovs_flow_cmd_fill_stats(const struct sw_flow *flow,
  629. struct sk_buff *skb)
  630. {
  631. struct ovs_flow_stats stats;
  632. __be16 tcp_flags;
  633. unsigned long used;
  634. ovs_flow_stats_get(flow, &stats, &used, &tcp_flags);
  635. if (used &&
  636. nla_put_u64(skb, OVS_FLOW_ATTR_USED, ovs_flow_used_time(used)))
  637. return -EMSGSIZE;
  638. if (stats.n_packets &&
  639. nla_put(skb, OVS_FLOW_ATTR_STATS, sizeof(struct ovs_flow_stats), &stats))
  640. return -EMSGSIZE;
  641. if ((u8)ntohs(tcp_flags) &&
  642. nla_put_u8(skb, OVS_FLOW_ATTR_TCP_FLAGS, (u8)ntohs(tcp_flags)))
  643. return -EMSGSIZE;
  644. return 0;
  645. }
  646. /* Called with ovs_mutex or RCU read lock. */
  647. static int ovs_flow_cmd_fill_actions(const struct sw_flow *flow,
  648. struct sk_buff *skb, int skb_orig_len)
  649. {
  650. struct nlattr *start;
  651. int err;
  652. /* If OVS_FLOW_ATTR_ACTIONS doesn't fit, skip dumping the actions if
  653. * this is the first flow to be dumped into 'skb'. This is unusual for
  654. * Netlink but individual action lists can be longer than
  655. * NLMSG_GOODSIZE and thus entirely undumpable if we didn't do this.
  656. * The userspace caller can always fetch the actions separately if it
  657. * really wants them. (Most userspace callers in fact don't care.)
  658. *
  659. * This can only fail for dump operations because the skb is always
  660. * properly sized for single flows.
  661. */
  662. start = nla_nest_start(skb, OVS_FLOW_ATTR_ACTIONS);
  663. if (start) {
  664. const struct sw_flow_actions *sf_acts;
  665. sf_acts = rcu_dereference_ovsl(flow->sf_acts);
  666. err = ovs_nla_put_actions(sf_acts->actions,
  667. sf_acts->actions_len, skb);
  668. if (!err)
  669. nla_nest_end(skb, start);
  670. else {
  671. if (skb_orig_len)
  672. return err;
  673. nla_nest_cancel(skb, start);
  674. }
  675. } else if (skb_orig_len) {
  676. return -EMSGSIZE;
  677. }
  678. return 0;
  679. }
  680. /* Called with ovs_mutex or RCU read lock. */
  681. static int ovs_flow_cmd_fill_info(const struct sw_flow *flow, int dp_ifindex,
  682. struct sk_buff *skb, u32 portid,
  683. u32 seq, u32 flags, u8 cmd, u32 ufid_flags)
  684. {
  685. const int skb_orig_len = skb->len;
  686. struct ovs_header *ovs_header;
  687. int err;
  688. ovs_header = genlmsg_put(skb, portid, seq, &dp_flow_genl_family,
  689. flags, cmd);
  690. if (!ovs_header)
  691. return -EMSGSIZE;
  692. ovs_header->dp_ifindex = dp_ifindex;
  693. err = ovs_nla_put_identifier(flow, skb);
  694. if (err)
  695. goto error;
  696. if (should_fill_key(&flow->id, ufid_flags)) {
  697. err = ovs_nla_put_masked_key(flow, skb);
  698. if (err)
  699. goto error;
  700. }
  701. if (should_fill_mask(ufid_flags)) {
  702. err = ovs_nla_put_mask(flow, skb);
  703. if (err)
  704. goto error;
  705. }
  706. err = ovs_flow_cmd_fill_stats(flow, skb);
  707. if (err)
  708. goto error;
  709. if (should_fill_actions(ufid_flags)) {
  710. err = ovs_flow_cmd_fill_actions(flow, skb, skb_orig_len);
  711. if (err)
  712. goto error;
  713. }
  714. genlmsg_end(skb, ovs_header);
  715. return 0;
  716. error:
  717. genlmsg_cancel(skb, ovs_header);
  718. return err;
  719. }
  720. /* May not be called with RCU read lock. */
  721. static struct sk_buff *ovs_flow_cmd_alloc_info(const struct sw_flow_actions *acts,
  722. const struct sw_flow_id *sfid,
  723. struct genl_info *info,
  724. bool always,
  725. uint32_t ufid_flags)
  726. {
  727. struct sk_buff *skb;
  728. size_t len;
  729. if (!always && !ovs_must_notify(&dp_flow_genl_family, info, 0))
  730. return NULL;
  731. len = ovs_flow_cmd_msg_size(acts, sfid, ufid_flags);
  732. skb = genlmsg_new_unicast(len, info, GFP_KERNEL);
  733. if (!skb)
  734. return ERR_PTR(-ENOMEM);
  735. return skb;
  736. }
  737. /* Called with ovs_mutex. */
  738. static struct sk_buff *ovs_flow_cmd_build_info(const struct sw_flow *flow,
  739. int dp_ifindex,
  740. struct genl_info *info, u8 cmd,
  741. bool always, u32 ufid_flags)
  742. {
  743. struct sk_buff *skb;
  744. int retval;
  745. skb = ovs_flow_cmd_alloc_info(ovsl_dereference(flow->sf_acts),
  746. &flow->id, info, always, ufid_flags);
  747. if (IS_ERR_OR_NULL(skb))
  748. return skb;
  749. retval = ovs_flow_cmd_fill_info(flow, dp_ifindex, skb,
  750. info->snd_portid, info->snd_seq, 0,
  751. cmd, ufid_flags);
  752. BUG_ON(retval < 0);
  753. return skb;
  754. }
  755. static int ovs_flow_cmd_new(struct sk_buff *skb, struct genl_info *info)
  756. {
  757. struct net *net = sock_net(skb->sk);
  758. struct nlattr **a = info->attrs;
  759. struct ovs_header *ovs_header = info->userhdr;
  760. struct sw_flow *flow = NULL, *new_flow;
  761. struct sw_flow_mask mask;
  762. struct sk_buff *reply;
  763. struct datapath *dp;
  764. struct sw_flow_key key;
  765. struct sw_flow_actions *acts;
  766. struct sw_flow_match match;
  767. u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
  768. int error;
  769. bool log = !a[OVS_FLOW_ATTR_PROBE];
  770. /* Must have key and actions. */
  771. error = -EINVAL;
  772. if (!a[OVS_FLOW_ATTR_KEY]) {
  773. OVS_NLERR(log, "Flow key attr not present in new flow.");
  774. goto error;
  775. }
  776. if (!a[OVS_FLOW_ATTR_ACTIONS]) {
  777. OVS_NLERR(log, "Flow actions attr not present in new flow.");
  778. goto error;
  779. }
  780. /* Most of the time we need to allocate a new flow, do it before
  781. * locking.
  782. */
  783. new_flow = ovs_flow_alloc();
  784. if (IS_ERR(new_flow)) {
  785. error = PTR_ERR(new_flow);
  786. goto error;
  787. }
  788. /* Extract key. */
  789. ovs_match_init(&match, &key, &mask);
  790. error = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
  791. a[OVS_FLOW_ATTR_MASK], log);
  792. if (error)
  793. goto err_kfree_flow;
  794. ovs_flow_mask_key(&new_flow->key, &key, &mask);
  795. /* Extract flow identifier. */
  796. error = ovs_nla_get_identifier(&new_flow->id, a[OVS_FLOW_ATTR_UFID],
  797. &key, log);
  798. if (error)
  799. goto err_kfree_flow;
  800. /* Validate actions. */
  801. error = ovs_nla_copy_actions(net, a[OVS_FLOW_ATTR_ACTIONS],
  802. &new_flow->key, &acts, log);
  803. if (error) {
  804. OVS_NLERR(log, "Flow actions may not be safe on all matching packets.");
  805. goto err_kfree_flow;
  806. }
  807. reply = ovs_flow_cmd_alloc_info(acts, &new_flow->id, info, false,
  808. ufid_flags);
  809. if (IS_ERR(reply)) {
  810. error = PTR_ERR(reply);
  811. goto err_kfree_acts;
  812. }
  813. ovs_lock();
  814. dp = get_dp(net, ovs_header->dp_ifindex);
  815. if (unlikely(!dp)) {
  816. error = -ENODEV;
  817. goto err_unlock_ovs;
  818. }
  819. /* Check if this is a duplicate flow */
  820. if (ovs_identifier_is_ufid(&new_flow->id))
  821. flow = ovs_flow_tbl_lookup_ufid(&dp->table, &new_flow->id);
  822. if (!flow)
  823. flow = ovs_flow_tbl_lookup(&dp->table, &key);
  824. if (likely(!flow)) {
  825. rcu_assign_pointer(new_flow->sf_acts, acts);
  826. /* Put flow in bucket. */
  827. error = ovs_flow_tbl_insert(&dp->table, new_flow, &mask);
  828. if (unlikely(error)) {
  829. acts = NULL;
  830. goto err_unlock_ovs;
  831. }
  832. if (unlikely(reply)) {
  833. error = ovs_flow_cmd_fill_info(new_flow,
  834. ovs_header->dp_ifindex,
  835. reply, info->snd_portid,
  836. info->snd_seq, 0,
  837. OVS_FLOW_CMD_NEW,
  838. ufid_flags);
  839. BUG_ON(error < 0);
  840. }
  841. ovs_unlock();
  842. } else {
  843. struct sw_flow_actions *old_acts;
  844. /* Bail out if we're not allowed to modify an existing flow.
  845. * We accept NLM_F_CREATE in place of the intended NLM_F_EXCL
  846. * because Generic Netlink treats the latter as a dump
  847. * request. We also accept NLM_F_EXCL in case that bug ever
  848. * gets fixed.
  849. */
  850. if (unlikely(info->nlhdr->nlmsg_flags & (NLM_F_CREATE
  851. | NLM_F_EXCL))) {
  852. error = -EEXIST;
  853. goto err_unlock_ovs;
  854. }
  855. /* The flow identifier has to be the same for flow updates.
  856. * Look for any overlapping flow.
  857. */
  858. if (unlikely(!ovs_flow_cmp(flow, &match))) {
  859. if (ovs_identifier_is_key(&flow->id))
  860. flow = ovs_flow_tbl_lookup_exact(&dp->table,
  861. &match);
  862. else /* UFID matches but key is different */
  863. flow = NULL;
  864. if (!flow) {
  865. error = -ENOENT;
  866. goto err_unlock_ovs;
  867. }
  868. }
  869. /* Update actions. */
  870. old_acts = ovsl_dereference(flow->sf_acts);
  871. rcu_assign_pointer(flow->sf_acts, acts);
  872. if (unlikely(reply)) {
  873. error = ovs_flow_cmd_fill_info(flow,
  874. ovs_header->dp_ifindex,
  875. reply, info->snd_portid,
  876. info->snd_seq, 0,
  877. OVS_FLOW_CMD_NEW,
  878. ufid_flags);
  879. BUG_ON(error < 0);
  880. }
  881. ovs_unlock();
  882. ovs_nla_free_flow_actions_rcu(old_acts);
  883. ovs_flow_free(new_flow, false);
  884. }
  885. if (reply)
  886. ovs_notify(&dp_flow_genl_family, reply, info);
  887. return 0;
  888. err_unlock_ovs:
  889. ovs_unlock();
  890. kfree_skb(reply);
  891. err_kfree_acts:
  892. ovs_nla_free_flow_actions(acts);
  893. err_kfree_flow:
  894. ovs_flow_free(new_flow, false);
  895. error:
  896. return error;
  897. }
  898. /* Factor out action copy to avoid "Wframe-larger-than=1024" warning. */
  899. static struct sw_flow_actions *get_flow_actions(struct net *net,
  900. const struct nlattr *a,
  901. const struct sw_flow_key *key,
  902. const struct sw_flow_mask *mask,
  903. bool log)
  904. {
  905. struct sw_flow_actions *acts;
  906. struct sw_flow_key masked_key;
  907. int error;
  908. ovs_flow_mask_key(&masked_key, key, mask);
  909. error = ovs_nla_copy_actions(net, a, &masked_key, &acts, log);
  910. if (error) {
  911. OVS_NLERR(log,
  912. "Actions may not be safe on all matching packets");
  913. return ERR_PTR(error);
  914. }
  915. return acts;
  916. }
  917. static int ovs_flow_cmd_set(struct sk_buff *skb, struct genl_info *info)
  918. {
  919. struct net *net = sock_net(skb->sk);
  920. struct nlattr **a = info->attrs;
  921. struct ovs_header *ovs_header = info->userhdr;
  922. struct sw_flow_key key;
  923. struct sw_flow *flow;
  924. struct sw_flow_mask mask;
  925. struct sk_buff *reply = NULL;
  926. struct datapath *dp;
  927. struct sw_flow_actions *old_acts = NULL, *acts = NULL;
  928. struct sw_flow_match match;
  929. struct sw_flow_id sfid;
  930. u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
  931. int error;
  932. bool log = !a[OVS_FLOW_ATTR_PROBE];
  933. bool ufid_present;
  934. /* Extract key. */
  935. error = -EINVAL;
  936. if (!a[OVS_FLOW_ATTR_KEY]) {
  937. OVS_NLERR(log, "Flow key attribute not present in set flow.");
  938. goto error;
  939. }
  940. ufid_present = ovs_nla_get_ufid(&sfid, a[OVS_FLOW_ATTR_UFID], log);
  941. ovs_match_init(&match, &key, &mask);
  942. error = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
  943. a[OVS_FLOW_ATTR_MASK], log);
  944. if (error)
  945. goto error;
  946. /* Validate actions. */
  947. if (a[OVS_FLOW_ATTR_ACTIONS]) {
  948. acts = get_flow_actions(net, a[OVS_FLOW_ATTR_ACTIONS], &key,
  949. &mask, log);
  950. if (IS_ERR(acts)) {
  951. error = PTR_ERR(acts);
  952. goto error;
  953. }
  954. /* Can allocate before locking if have acts. */
  955. reply = ovs_flow_cmd_alloc_info(acts, &sfid, info, false,
  956. ufid_flags);
  957. if (IS_ERR(reply)) {
  958. error = PTR_ERR(reply);
  959. goto err_kfree_acts;
  960. }
  961. }
  962. ovs_lock();
  963. dp = get_dp(net, ovs_header->dp_ifindex);
  964. if (unlikely(!dp)) {
  965. error = -ENODEV;
  966. goto err_unlock_ovs;
  967. }
  968. /* Check that the flow exists. */
  969. if (ufid_present)
  970. flow = ovs_flow_tbl_lookup_ufid(&dp->table, &sfid);
  971. else
  972. flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
  973. if (unlikely(!flow)) {
  974. error = -ENOENT;
  975. goto err_unlock_ovs;
  976. }
  977. /* Update actions, if present. */
  978. if (likely(acts)) {
  979. old_acts = ovsl_dereference(flow->sf_acts);
  980. rcu_assign_pointer(flow->sf_acts, acts);
  981. if (unlikely(reply)) {
  982. error = ovs_flow_cmd_fill_info(flow,
  983. ovs_header->dp_ifindex,
  984. reply, info->snd_portid,
  985. info->snd_seq, 0,
  986. OVS_FLOW_CMD_NEW,
  987. ufid_flags);
  988. BUG_ON(error < 0);
  989. }
  990. } else {
  991. /* Could not alloc without acts before locking. */
  992. reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex,
  993. info, OVS_FLOW_CMD_NEW, false,
  994. ufid_flags);
  995. if (unlikely(IS_ERR(reply))) {
  996. error = PTR_ERR(reply);
  997. goto err_unlock_ovs;
  998. }
  999. }
  1000. /* Clear stats. */
  1001. if (a[OVS_FLOW_ATTR_CLEAR])
  1002. ovs_flow_stats_clear(flow);
  1003. ovs_unlock();
  1004. if (reply)
  1005. ovs_notify(&dp_flow_genl_family, reply, info);
  1006. if (old_acts)
  1007. ovs_nla_free_flow_actions_rcu(old_acts);
  1008. return 0;
  1009. err_unlock_ovs:
  1010. ovs_unlock();
  1011. kfree_skb(reply);
  1012. err_kfree_acts:
  1013. ovs_nla_free_flow_actions(acts);
  1014. error:
  1015. return error;
  1016. }
  1017. static int ovs_flow_cmd_get(struct sk_buff *skb, struct genl_info *info)
  1018. {
  1019. struct nlattr **a = info->attrs;
  1020. struct ovs_header *ovs_header = info->userhdr;
  1021. struct net *net = sock_net(skb->sk);
  1022. struct sw_flow_key key;
  1023. struct sk_buff *reply;
  1024. struct sw_flow *flow;
  1025. struct datapath *dp;
  1026. struct sw_flow_match match;
  1027. struct sw_flow_id ufid;
  1028. u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
  1029. int err = 0;
  1030. bool log = !a[OVS_FLOW_ATTR_PROBE];
  1031. bool ufid_present;
  1032. ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
  1033. if (a[OVS_FLOW_ATTR_KEY]) {
  1034. ovs_match_init(&match, &key, NULL);
  1035. err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY], NULL,
  1036. log);
  1037. } else if (!ufid_present) {
  1038. OVS_NLERR(log,
  1039. "Flow get message rejected, Key attribute missing.");
  1040. err = -EINVAL;
  1041. }
  1042. if (err)
  1043. return err;
  1044. ovs_lock();
  1045. dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
  1046. if (!dp) {
  1047. err = -ENODEV;
  1048. goto unlock;
  1049. }
  1050. if (ufid_present)
  1051. flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
  1052. else
  1053. flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
  1054. if (!flow) {
  1055. err = -ENOENT;
  1056. goto unlock;
  1057. }
  1058. reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex, info,
  1059. OVS_FLOW_CMD_NEW, true, ufid_flags);
  1060. if (IS_ERR(reply)) {
  1061. err = PTR_ERR(reply);
  1062. goto unlock;
  1063. }
  1064. ovs_unlock();
  1065. return genlmsg_reply(reply, info);
  1066. unlock:
  1067. ovs_unlock();
  1068. return err;
  1069. }
  1070. static int ovs_flow_cmd_del(struct sk_buff *skb, struct genl_info *info)
  1071. {
  1072. struct nlattr **a = info->attrs;
  1073. struct ovs_header *ovs_header = info->userhdr;
  1074. struct net *net = sock_net(skb->sk);
  1075. struct sw_flow_key key;
  1076. struct sk_buff *reply;
  1077. struct sw_flow *flow = NULL;
  1078. struct datapath *dp;
  1079. struct sw_flow_match match;
  1080. struct sw_flow_id ufid;
  1081. u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
  1082. int err;
  1083. bool log = !a[OVS_FLOW_ATTR_PROBE];
  1084. bool ufid_present;
  1085. ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
  1086. if (a[OVS_FLOW_ATTR_KEY]) {
  1087. ovs_match_init(&match, &key, NULL);
  1088. err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
  1089. NULL, log);
  1090. if (unlikely(err))
  1091. return err;
  1092. }
  1093. ovs_lock();
  1094. dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
  1095. if (unlikely(!dp)) {
  1096. err = -ENODEV;
  1097. goto unlock;
  1098. }
  1099. if (unlikely(!a[OVS_FLOW_ATTR_KEY] && !ufid_present)) {
  1100. err = ovs_flow_tbl_flush(&dp->table);
  1101. goto unlock;
  1102. }
  1103. if (ufid_present)
  1104. flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
  1105. else
  1106. flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
  1107. if (unlikely(!flow)) {
  1108. err = -ENOENT;
  1109. goto unlock;
  1110. }
  1111. ovs_flow_tbl_remove(&dp->table, flow);
  1112. ovs_unlock();
  1113. reply = ovs_flow_cmd_alloc_info((const struct sw_flow_actions __force *) flow->sf_acts,
  1114. &flow->id, info, false, ufid_flags);
  1115. if (likely(reply)) {
  1116. if (likely(!IS_ERR(reply))) {
  1117. rcu_read_lock(); /*To keep RCU checker happy. */
  1118. err = ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex,
  1119. reply, info->snd_portid,
  1120. info->snd_seq, 0,
  1121. OVS_FLOW_CMD_DEL,
  1122. ufid_flags);
  1123. rcu_read_unlock();
  1124. BUG_ON(err < 0);
  1125. ovs_notify(&dp_flow_genl_family, reply, info);
  1126. } else {
  1127. netlink_set_err(sock_net(skb->sk)->genl_sock, 0, 0, PTR_ERR(reply));
  1128. }
  1129. }
  1130. ovs_flow_free(flow, true);
  1131. return 0;
  1132. unlock:
  1133. ovs_unlock();
  1134. return err;
  1135. }
  1136. static int ovs_flow_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
  1137. {
  1138. struct nlattr *a[__OVS_FLOW_ATTR_MAX];
  1139. struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
  1140. struct table_instance *ti;
  1141. struct datapath *dp;
  1142. u32 ufid_flags;
  1143. int err;
  1144. err = genlmsg_parse(cb->nlh, &dp_flow_genl_family, a,
  1145. OVS_FLOW_ATTR_MAX, flow_policy);
  1146. if (err)
  1147. return err;
  1148. ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
  1149. rcu_read_lock();
  1150. dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
  1151. if (!dp) {
  1152. rcu_read_unlock();
  1153. return -ENODEV;
  1154. }
  1155. ti = rcu_dereference(dp->table.ti);
  1156. for (;;) {
  1157. struct sw_flow *flow;
  1158. u32 bucket, obj;
  1159. bucket = cb->args[0];
  1160. obj = cb->args[1];
  1161. flow = ovs_flow_tbl_dump_next(ti, &bucket, &obj);
  1162. if (!flow)
  1163. break;
  1164. if (ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex, skb,
  1165. NETLINK_CB(cb->skb).portid,
  1166. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1167. OVS_FLOW_CMD_NEW, ufid_flags) < 0)
  1168. break;
  1169. cb->args[0] = bucket;
  1170. cb->args[1] = obj;
  1171. }
  1172. rcu_read_unlock();
  1173. return skb->len;
  1174. }
  1175. static const struct nla_policy flow_policy[OVS_FLOW_ATTR_MAX + 1] = {
  1176. [OVS_FLOW_ATTR_KEY] = { .type = NLA_NESTED },
  1177. [OVS_FLOW_ATTR_MASK] = { .type = NLA_NESTED },
  1178. [OVS_FLOW_ATTR_ACTIONS] = { .type = NLA_NESTED },
  1179. [OVS_FLOW_ATTR_CLEAR] = { .type = NLA_FLAG },
  1180. [OVS_FLOW_ATTR_PROBE] = { .type = NLA_FLAG },
  1181. [OVS_FLOW_ATTR_UFID] = { .type = NLA_UNSPEC, .len = 1 },
  1182. [OVS_FLOW_ATTR_UFID_FLAGS] = { .type = NLA_U32 },
  1183. };
  1184. static const struct genl_ops dp_flow_genl_ops[] = {
  1185. { .cmd = OVS_FLOW_CMD_NEW,
  1186. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1187. .policy = flow_policy,
  1188. .doit = ovs_flow_cmd_new
  1189. },
  1190. { .cmd = OVS_FLOW_CMD_DEL,
  1191. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1192. .policy = flow_policy,
  1193. .doit = ovs_flow_cmd_del
  1194. },
  1195. { .cmd = OVS_FLOW_CMD_GET,
  1196. .flags = 0, /* OK for unprivileged users. */
  1197. .policy = flow_policy,
  1198. .doit = ovs_flow_cmd_get,
  1199. .dumpit = ovs_flow_cmd_dump
  1200. },
  1201. { .cmd = OVS_FLOW_CMD_SET,
  1202. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1203. .policy = flow_policy,
  1204. .doit = ovs_flow_cmd_set,
  1205. },
  1206. };
  1207. static struct genl_family dp_flow_genl_family = {
  1208. .id = GENL_ID_GENERATE,
  1209. .hdrsize = sizeof(struct ovs_header),
  1210. .name = OVS_FLOW_FAMILY,
  1211. .version = OVS_FLOW_VERSION,
  1212. .maxattr = OVS_FLOW_ATTR_MAX,
  1213. .netnsok = true,
  1214. .parallel_ops = true,
  1215. .ops = dp_flow_genl_ops,
  1216. .n_ops = ARRAY_SIZE(dp_flow_genl_ops),
  1217. .mcgrps = &ovs_dp_flow_multicast_group,
  1218. .n_mcgrps = 1,
  1219. };
  1220. static size_t ovs_dp_cmd_msg_size(void)
  1221. {
  1222. size_t msgsize = NLMSG_ALIGN(sizeof(struct ovs_header));
  1223. msgsize += nla_total_size(IFNAMSIZ);
  1224. msgsize += nla_total_size(sizeof(struct ovs_dp_stats));
  1225. msgsize += nla_total_size(sizeof(struct ovs_dp_megaflow_stats));
  1226. msgsize += nla_total_size(sizeof(u32)); /* OVS_DP_ATTR_USER_FEATURES */
  1227. return msgsize;
  1228. }
  1229. /* Called with ovs_mutex. */
  1230. static int ovs_dp_cmd_fill_info(struct datapath *dp, struct sk_buff *skb,
  1231. u32 portid, u32 seq, u32 flags, u8 cmd)
  1232. {
  1233. struct ovs_header *ovs_header;
  1234. struct ovs_dp_stats dp_stats;
  1235. struct ovs_dp_megaflow_stats dp_megaflow_stats;
  1236. int err;
  1237. ovs_header = genlmsg_put(skb, portid, seq, &dp_datapath_genl_family,
  1238. flags, cmd);
  1239. if (!ovs_header)
  1240. goto error;
  1241. ovs_header->dp_ifindex = get_dpifindex(dp);
  1242. err = nla_put_string(skb, OVS_DP_ATTR_NAME, ovs_dp_name(dp));
  1243. if (err)
  1244. goto nla_put_failure;
  1245. get_dp_stats(dp, &dp_stats, &dp_megaflow_stats);
  1246. if (nla_put(skb, OVS_DP_ATTR_STATS, sizeof(struct ovs_dp_stats),
  1247. &dp_stats))
  1248. goto nla_put_failure;
  1249. if (nla_put(skb, OVS_DP_ATTR_MEGAFLOW_STATS,
  1250. sizeof(struct ovs_dp_megaflow_stats),
  1251. &dp_megaflow_stats))
  1252. goto nla_put_failure;
  1253. if (nla_put_u32(skb, OVS_DP_ATTR_USER_FEATURES, dp->user_features))
  1254. goto nla_put_failure;
  1255. genlmsg_end(skb, ovs_header);
  1256. return 0;
  1257. nla_put_failure:
  1258. genlmsg_cancel(skb, ovs_header);
  1259. error:
  1260. return -EMSGSIZE;
  1261. }
  1262. static struct sk_buff *ovs_dp_cmd_alloc_info(struct genl_info *info)
  1263. {
  1264. return genlmsg_new_unicast(ovs_dp_cmd_msg_size(), info, GFP_KERNEL);
  1265. }
  1266. /* Called with rcu_read_lock or ovs_mutex. */
  1267. static struct datapath *lookup_datapath(struct net *net,
  1268. const struct ovs_header *ovs_header,
  1269. struct nlattr *a[OVS_DP_ATTR_MAX + 1])
  1270. {
  1271. struct datapath *dp;
  1272. if (!a[OVS_DP_ATTR_NAME])
  1273. dp = get_dp(net, ovs_header->dp_ifindex);
  1274. else {
  1275. struct vport *vport;
  1276. vport = ovs_vport_locate(net, nla_data(a[OVS_DP_ATTR_NAME]));
  1277. dp = vport && vport->port_no == OVSP_LOCAL ? vport->dp : NULL;
  1278. }
  1279. return dp ? dp : ERR_PTR(-ENODEV);
  1280. }
  1281. static void ovs_dp_reset_user_features(struct sk_buff *skb, struct genl_info *info)
  1282. {
  1283. struct datapath *dp;
  1284. dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
  1285. if (IS_ERR(dp))
  1286. return;
  1287. WARN(dp->user_features, "Dropping previously announced user features\n");
  1288. dp->user_features = 0;
  1289. }
  1290. static void ovs_dp_change(struct datapath *dp, struct nlattr *a[])
  1291. {
  1292. if (a[OVS_DP_ATTR_USER_FEATURES])
  1293. dp->user_features = nla_get_u32(a[OVS_DP_ATTR_USER_FEATURES]);
  1294. }
  1295. static int ovs_dp_cmd_new(struct sk_buff *skb, struct genl_info *info)
  1296. {
  1297. struct nlattr **a = info->attrs;
  1298. struct vport_parms parms;
  1299. struct sk_buff *reply;
  1300. struct datapath *dp;
  1301. struct vport *vport;
  1302. struct ovs_net *ovs_net;
  1303. int err, i;
  1304. err = -EINVAL;
  1305. if (!a[OVS_DP_ATTR_NAME] || !a[OVS_DP_ATTR_UPCALL_PID])
  1306. goto err;
  1307. reply = ovs_dp_cmd_alloc_info(info);
  1308. if (!reply)
  1309. return -ENOMEM;
  1310. err = -ENOMEM;
  1311. dp = kzalloc(sizeof(*dp), GFP_KERNEL);
  1312. if (dp == NULL)
  1313. goto err_free_reply;
  1314. ovs_dp_set_net(dp, sock_net(skb->sk));
  1315. /* Allocate table. */
  1316. err = ovs_flow_tbl_init(&dp->table);
  1317. if (err)
  1318. goto err_free_dp;
  1319. dp->stats_percpu = netdev_alloc_pcpu_stats(struct dp_stats_percpu);
  1320. if (!dp->stats_percpu) {
  1321. err = -ENOMEM;
  1322. goto err_destroy_table;
  1323. }
  1324. dp->ports = kmalloc(DP_VPORT_HASH_BUCKETS * sizeof(struct hlist_head),
  1325. GFP_KERNEL);
  1326. if (!dp->ports) {
  1327. err = -ENOMEM;
  1328. goto err_destroy_percpu;
  1329. }
  1330. for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
  1331. INIT_HLIST_HEAD(&dp->ports[i]);
  1332. /* Set up our datapath device. */
  1333. parms.name = nla_data(a[OVS_DP_ATTR_NAME]);
  1334. parms.type = OVS_VPORT_TYPE_INTERNAL;
  1335. parms.options = NULL;
  1336. parms.dp = dp;
  1337. parms.port_no = OVSP_LOCAL;
  1338. parms.upcall_portids = a[OVS_DP_ATTR_UPCALL_PID];
  1339. ovs_dp_change(dp, a);
  1340. /* So far only local changes have been made, now need the lock. */
  1341. ovs_lock();
  1342. vport = new_vport(&parms);
  1343. if (IS_ERR(vport)) {
  1344. err = PTR_ERR(vport);
  1345. if (err == -EBUSY)
  1346. err = -EEXIST;
  1347. if (err == -EEXIST) {
  1348. /* An outdated user space instance that does not understand
  1349. * the concept of user_features has attempted to create a new
  1350. * datapath and is likely to reuse it. Drop all user features.
  1351. */
  1352. if (info->genlhdr->version < OVS_DP_VER_FEATURES)
  1353. ovs_dp_reset_user_features(skb, info);
  1354. }
  1355. goto err_destroy_ports_array;
  1356. }
  1357. err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
  1358. info->snd_seq, 0, OVS_DP_CMD_NEW);
  1359. BUG_ON(err < 0);
  1360. ovs_net = net_generic(ovs_dp_get_net(dp), ovs_net_id);
  1361. list_add_tail_rcu(&dp->list_node, &ovs_net->dps);
  1362. ovs_unlock();
  1363. ovs_notify(&dp_datapath_genl_family, reply, info);
  1364. return 0;
  1365. err_destroy_ports_array:
  1366. ovs_unlock();
  1367. kfree(dp->ports);
  1368. err_destroy_percpu:
  1369. free_percpu(dp->stats_percpu);
  1370. err_destroy_table:
  1371. ovs_flow_tbl_destroy(&dp->table);
  1372. err_free_dp:
  1373. kfree(dp);
  1374. err_free_reply:
  1375. kfree_skb(reply);
  1376. err:
  1377. return err;
  1378. }
  1379. /* Called with ovs_mutex. */
  1380. static void __dp_destroy(struct datapath *dp)
  1381. {
  1382. int i;
  1383. for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
  1384. struct vport *vport;
  1385. struct hlist_node *n;
  1386. hlist_for_each_entry_safe(vport, n, &dp->ports[i], dp_hash_node)
  1387. if (vport->port_no != OVSP_LOCAL)
  1388. ovs_dp_detach_port(vport);
  1389. }
  1390. list_del_rcu(&dp->list_node);
  1391. /* OVSP_LOCAL is datapath internal port. We need to make sure that
  1392. * all ports in datapath are destroyed first before freeing datapath.
  1393. */
  1394. ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
  1395. /* RCU destroy the flow table */
  1396. call_rcu(&dp->rcu, destroy_dp_rcu);
  1397. }
  1398. static int ovs_dp_cmd_del(struct sk_buff *skb, struct genl_info *info)
  1399. {
  1400. struct sk_buff *reply;
  1401. struct datapath *dp;
  1402. int err;
  1403. reply = ovs_dp_cmd_alloc_info(info);
  1404. if (!reply)
  1405. return -ENOMEM;
  1406. ovs_lock();
  1407. dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
  1408. err = PTR_ERR(dp);
  1409. if (IS_ERR(dp))
  1410. goto err_unlock_free;
  1411. err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
  1412. info->snd_seq, 0, OVS_DP_CMD_DEL);
  1413. BUG_ON(err < 0);
  1414. __dp_destroy(dp);
  1415. ovs_unlock();
  1416. ovs_notify(&dp_datapath_genl_family, reply, info);
  1417. return 0;
  1418. err_unlock_free:
  1419. ovs_unlock();
  1420. kfree_skb(reply);
  1421. return err;
  1422. }
  1423. static int ovs_dp_cmd_set(struct sk_buff *skb, struct genl_info *info)
  1424. {
  1425. struct sk_buff *reply;
  1426. struct datapath *dp;
  1427. int err;
  1428. reply = ovs_dp_cmd_alloc_info(info);
  1429. if (!reply)
  1430. return -ENOMEM;
  1431. ovs_lock();
  1432. dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
  1433. err = PTR_ERR(dp);
  1434. if (IS_ERR(dp))
  1435. goto err_unlock_free;
  1436. ovs_dp_change(dp, info->attrs);
  1437. err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
  1438. info->snd_seq, 0, OVS_DP_CMD_NEW);
  1439. BUG_ON(err < 0);
  1440. ovs_unlock();
  1441. ovs_notify(&dp_datapath_genl_family, reply, info);
  1442. return 0;
  1443. err_unlock_free:
  1444. ovs_unlock();
  1445. kfree_skb(reply);
  1446. return err;
  1447. }
  1448. static int ovs_dp_cmd_get(struct sk_buff *skb, struct genl_info *info)
  1449. {
  1450. struct sk_buff *reply;
  1451. struct datapath *dp;
  1452. int err;
  1453. reply = ovs_dp_cmd_alloc_info(info);
  1454. if (!reply)
  1455. return -ENOMEM;
  1456. ovs_lock();
  1457. dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
  1458. if (IS_ERR(dp)) {
  1459. err = PTR_ERR(dp);
  1460. goto err_unlock_free;
  1461. }
  1462. err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
  1463. info->snd_seq, 0, OVS_DP_CMD_NEW);
  1464. BUG_ON(err < 0);
  1465. ovs_unlock();
  1466. return genlmsg_reply(reply, info);
  1467. err_unlock_free:
  1468. ovs_unlock();
  1469. kfree_skb(reply);
  1470. return err;
  1471. }
  1472. static int ovs_dp_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
  1473. {
  1474. struct ovs_net *ovs_net = net_generic(sock_net(skb->sk), ovs_net_id);
  1475. struct datapath *dp;
  1476. int skip = cb->args[0];
  1477. int i = 0;
  1478. ovs_lock();
  1479. list_for_each_entry(dp, &ovs_net->dps, list_node) {
  1480. if (i >= skip &&
  1481. ovs_dp_cmd_fill_info(dp, skb, NETLINK_CB(cb->skb).portid,
  1482. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1483. OVS_DP_CMD_NEW) < 0)
  1484. break;
  1485. i++;
  1486. }
  1487. ovs_unlock();
  1488. cb->args[0] = i;
  1489. return skb->len;
  1490. }
  1491. static const struct nla_policy datapath_policy[OVS_DP_ATTR_MAX + 1] = {
  1492. [OVS_DP_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
  1493. [OVS_DP_ATTR_UPCALL_PID] = { .type = NLA_U32 },
  1494. [OVS_DP_ATTR_USER_FEATURES] = { .type = NLA_U32 },
  1495. };
  1496. static const struct genl_ops dp_datapath_genl_ops[] = {
  1497. { .cmd = OVS_DP_CMD_NEW,
  1498. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1499. .policy = datapath_policy,
  1500. .doit = ovs_dp_cmd_new
  1501. },
  1502. { .cmd = OVS_DP_CMD_DEL,
  1503. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1504. .policy = datapath_policy,
  1505. .doit = ovs_dp_cmd_del
  1506. },
  1507. { .cmd = OVS_DP_CMD_GET,
  1508. .flags = 0, /* OK for unprivileged users. */
  1509. .policy = datapath_policy,
  1510. .doit = ovs_dp_cmd_get,
  1511. .dumpit = ovs_dp_cmd_dump
  1512. },
  1513. { .cmd = OVS_DP_CMD_SET,
  1514. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1515. .policy = datapath_policy,
  1516. .doit = ovs_dp_cmd_set,
  1517. },
  1518. };
  1519. static struct genl_family dp_datapath_genl_family = {
  1520. .id = GENL_ID_GENERATE,
  1521. .hdrsize = sizeof(struct ovs_header),
  1522. .name = OVS_DATAPATH_FAMILY,
  1523. .version = OVS_DATAPATH_VERSION,
  1524. .maxattr = OVS_DP_ATTR_MAX,
  1525. .netnsok = true,
  1526. .parallel_ops = true,
  1527. .ops = dp_datapath_genl_ops,
  1528. .n_ops = ARRAY_SIZE(dp_datapath_genl_ops),
  1529. .mcgrps = &ovs_dp_datapath_multicast_group,
  1530. .n_mcgrps = 1,
  1531. };
  1532. /* Called with ovs_mutex or RCU read lock. */
  1533. static int ovs_vport_cmd_fill_info(struct vport *vport, struct sk_buff *skb,
  1534. u32 portid, u32 seq, u32 flags, u8 cmd)
  1535. {
  1536. struct ovs_header *ovs_header;
  1537. struct ovs_vport_stats vport_stats;
  1538. int err;
  1539. ovs_header = genlmsg_put(skb, portid, seq, &dp_vport_genl_family,
  1540. flags, cmd);
  1541. if (!ovs_header)
  1542. return -EMSGSIZE;
  1543. ovs_header->dp_ifindex = get_dpifindex(vport->dp);
  1544. if (nla_put_u32(skb, OVS_VPORT_ATTR_PORT_NO, vport->port_no) ||
  1545. nla_put_u32(skb, OVS_VPORT_ATTR_TYPE, vport->ops->type) ||
  1546. nla_put_string(skb, OVS_VPORT_ATTR_NAME,
  1547. ovs_vport_name(vport)))
  1548. goto nla_put_failure;
  1549. ovs_vport_get_stats(vport, &vport_stats);
  1550. if (nla_put(skb, OVS_VPORT_ATTR_STATS, sizeof(struct ovs_vport_stats),
  1551. &vport_stats))
  1552. goto nla_put_failure;
  1553. if (ovs_vport_get_upcall_portids(vport, skb))
  1554. goto nla_put_failure;
  1555. err = ovs_vport_get_options(vport, skb);
  1556. if (err == -EMSGSIZE)
  1557. goto error;
  1558. genlmsg_end(skb, ovs_header);
  1559. return 0;
  1560. nla_put_failure:
  1561. err = -EMSGSIZE;
  1562. error:
  1563. genlmsg_cancel(skb, ovs_header);
  1564. return err;
  1565. }
  1566. static struct sk_buff *ovs_vport_cmd_alloc_info(void)
  1567. {
  1568. return nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  1569. }
  1570. /* Called with ovs_mutex, only via ovs_dp_notify_wq(). */
  1571. struct sk_buff *ovs_vport_cmd_build_info(struct vport *vport, u32 portid,
  1572. u32 seq, u8 cmd)
  1573. {
  1574. struct sk_buff *skb;
  1575. int retval;
  1576. skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  1577. if (!skb)
  1578. return ERR_PTR(-ENOMEM);
  1579. retval = ovs_vport_cmd_fill_info(vport, skb, portid, seq, 0, cmd);
  1580. BUG_ON(retval < 0);
  1581. return skb;
  1582. }
  1583. /* Called with ovs_mutex or RCU read lock. */
  1584. static struct vport *lookup_vport(struct net *net,
  1585. const struct ovs_header *ovs_header,
  1586. struct nlattr *a[OVS_VPORT_ATTR_MAX + 1])
  1587. {
  1588. struct datapath *dp;
  1589. struct vport *vport;
  1590. if (a[OVS_VPORT_ATTR_NAME]) {
  1591. vport = ovs_vport_locate(net, nla_data(a[OVS_VPORT_ATTR_NAME]));
  1592. if (!vport)
  1593. return ERR_PTR(-ENODEV);
  1594. if (ovs_header->dp_ifindex &&
  1595. ovs_header->dp_ifindex != get_dpifindex(vport->dp))
  1596. return ERR_PTR(-ENODEV);
  1597. return vport;
  1598. } else if (a[OVS_VPORT_ATTR_PORT_NO]) {
  1599. u32 port_no = nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]);
  1600. if (port_no >= DP_MAX_PORTS)
  1601. return ERR_PTR(-EFBIG);
  1602. dp = get_dp(net, ovs_header->dp_ifindex);
  1603. if (!dp)
  1604. return ERR_PTR(-ENODEV);
  1605. vport = ovs_vport_ovsl_rcu(dp, port_no);
  1606. if (!vport)
  1607. return ERR_PTR(-ENODEV);
  1608. return vport;
  1609. } else
  1610. return ERR_PTR(-EINVAL);
  1611. }
  1612. static int ovs_vport_cmd_new(struct sk_buff *skb, struct genl_info *info)
  1613. {
  1614. struct nlattr **a = info->attrs;
  1615. struct ovs_header *ovs_header = info->userhdr;
  1616. struct vport_parms parms;
  1617. struct sk_buff *reply;
  1618. struct vport *vport;
  1619. struct datapath *dp;
  1620. u32 port_no;
  1621. int err;
  1622. if (!a[OVS_VPORT_ATTR_NAME] || !a[OVS_VPORT_ATTR_TYPE] ||
  1623. !a[OVS_VPORT_ATTR_UPCALL_PID])
  1624. return -EINVAL;
  1625. port_no = a[OVS_VPORT_ATTR_PORT_NO]
  1626. ? nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]) : 0;
  1627. if (port_no >= DP_MAX_PORTS)
  1628. return -EFBIG;
  1629. reply = ovs_vport_cmd_alloc_info();
  1630. if (!reply)
  1631. return -ENOMEM;
  1632. ovs_lock();
  1633. restart:
  1634. dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
  1635. err = -ENODEV;
  1636. if (!dp)
  1637. goto exit_unlock_free;
  1638. if (port_no) {
  1639. vport = ovs_vport_ovsl(dp, port_no);
  1640. err = -EBUSY;
  1641. if (vport)
  1642. goto exit_unlock_free;
  1643. } else {
  1644. for (port_no = 1; ; port_no++) {
  1645. if (port_no >= DP_MAX_PORTS) {
  1646. err = -EFBIG;
  1647. goto exit_unlock_free;
  1648. }
  1649. vport = ovs_vport_ovsl(dp, port_no);
  1650. if (!vport)
  1651. break;
  1652. }
  1653. }
  1654. parms.name = nla_data(a[OVS_VPORT_ATTR_NAME]);
  1655. parms.type = nla_get_u32(a[OVS_VPORT_ATTR_TYPE]);
  1656. parms.options = a[OVS_VPORT_ATTR_OPTIONS];
  1657. parms.dp = dp;
  1658. parms.port_no = port_no;
  1659. parms.upcall_portids = a[OVS_VPORT_ATTR_UPCALL_PID];
  1660. vport = new_vport(&parms);
  1661. err = PTR_ERR(vport);
  1662. if (IS_ERR(vport)) {
  1663. if (err == -EAGAIN)
  1664. goto restart;
  1665. goto exit_unlock_free;
  1666. }
  1667. err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
  1668. info->snd_seq, 0, OVS_VPORT_CMD_NEW);
  1669. BUG_ON(err < 0);
  1670. ovs_unlock();
  1671. ovs_notify(&dp_vport_genl_family, reply, info);
  1672. return 0;
  1673. exit_unlock_free:
  1674. ovs_unlock();
  1675. kfree_skb(reply);
  1676. return err;
  1677. }
  1678. static int ovs_vport_cmd_set(struct sk_buff *skb, struct genl_info *info)
  1679. {
  1680. struct nlattr **a = info->attrs;
  1681. struct sk_buff *reply;
  1682. struct vport *vport;
  1683. int err;
  1684. reply = ovs_vport_cmd_alloc_info();
  1685. if (!reply)
  1686. return -ENOMEM;
  1687. ovs_lock();
  1688. vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
  1689. err = PTR_ERR(vport);
  1690. if (IS_ERR(vport))
  1691. goto exit_unlock_free;
  1692. if (a[OVS_VPORT_ATTR_TYPE] &&
  1693. nla_get_u32(a[OVS_VPORT_ATTR_TYPE]) != vport->ops->type) {
  1694. err = -EINVAL;
  1695. goto exit_unlock_free;
  1696. }
  1697. if (a[OVS_VPORT_ATTR_OPTIONS]) {
  1698. err = ovs_vport_set_options(vport, a[OVS_VPORT_ATTR_OPTIONS]);
  1699. if (err)
  1700. goto exit_unlock_free;
  1701. }
  1702. if (a[OVS_VPORT_ATTR_UPCALL_PID]) {
  1703. struct nlattr *ids = a[OVS_VPORT_ATTR_UPCALL_PID];
  1704. err = ovs_vport_set_upcall_portids(vport, ids);
  1705. if (err)
  1706. goto exit_unlock_free;
  1707. }
  1708. err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
  1709. info->snd_seq, 0, OVS_VPORT_CMD_NEW);
  1710. BUG_ON(err < 0);
  1711. ovs_unlock();
  1712. ovs_notify(&dp_vport_genl_family, reply, info);
  1713. return 0;
  1714. exit_unlock_free:
  1715. ovs_unlock();
  1716. kfree_skb(reply);
  1717. return err;
  1718. }
  1719. static int ovs_vport_cmd_del(struct sk_buff *skb, struct genl_info *info)
  1720. {
  1721. struct nlattr **a = info->attrs;
  1722. struct sk_buff *reply;
  1723. struct vport *vport;
  1724. int err;
  1725. reply = ovs_vport_cmd_alloc_info();
  1726. if (!reply)
  1727. return -ENOMEM;
  1728. ovs_lock();
  1729. vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
  1730. err = PTR_ERR(vport);
  1731. if (IS_ERR(vport))
  1732. goto exit_unlock_free;
  1733. if (vport->port_no == OVSP_LOCAL) {
  1734. err = -EINVAL;
  1735. goto exit_unlock_free;
  1736. }
  1737. err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
  1738. info->snd_seq, 0, OVS_VPORT_CMD_DEL);
  1739. BUG_ON(err < 0);
  1740. ovs_dp_detach_port(vport);
  1741. ovs_unlock();
  1742. ovs_notify(&dp_vport_genl_family, reply, info);
  1743. return 0;
  1744. exit_unlock_free:
  1745. ovs_unlock();
  1746. kfree_skb(reply);
  1747. return err;
  1748. }
  1749. static int ovs_vport_cmd_get(struct sk_buff *skb, struct genl_info *info)
  1750. {
  1751. struct nlattr **a = info->attrs;
  1752. struct ovs_header *ovs_header = info->userhdr;
  1753. struct sk_buff *reply;
  1754. struct vport *vport;
  1755. int err;
  1756. reply = ovs_vport_cmd_alloc_info();
  1757. if (!reply)
  1758. return -ENOMEM;
  1759. rcu_read_lock();
  1760. vport = lookup_vport(sock_net(skb->sk), ovs_header, a);
  1761. err = PTR_ERR(vport);
  1762. if (IS_ERR(vport))
  1763. goto exit_unlock_free;
  1764. err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
  1765. info->snd_seq, 0, OVS_VPORT_CMD_NEW);
  1766. BUG_ON(err < 0);
  1767. rcu_read_unlock();
  1768. return genlmsg_reply(reply, info);
  1769. exit_unlock_free:
  1770. rcu_read_unlock();
  1771. kfree_skb(reply);
  1772. return err;
  1773. }
  1774. static int ovs_vport_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
  1775. {
  1776. struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
  1777. struct datapath *dp;
  1778. int bucket = cb->args[0], skip = cb->args[1];
  1779. int i, j = 0;
  1780. rcu_read_lock();
  1781. dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
  1782. if (!dp) {
  1783. rcu_read_unlock();
  1784. return -ENODEV;
  1785. }
  1786. for (i = bucket; i < DP_VPORT_HASH_BUCKETS; i++) {
  1787. struct vport *vport;
  1788. j = 0;
  1789. hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
  1790. if (j >= skip &&
  1791. ovs_vport_cmd_fill_info(vport, skb,
  1792. NETLINK_CB(cb->skb).portid,
  1793. cb->nlh->nlmsg_seq,
  1794. NLM_F_MULTI,
  1795. OVS_VPORT_CMD_NEW) < 0)
  1796. goto out;
  1797. j++;
  1798. }
  1799. skip = 0;
  1800. }
  1801. out:
  1802. rcu_read_unlock();
  1803. cb->args[0] = i;
  1804. cb->args[1] = j;
  1805. return skb->len;
  1806. }
  1807. static const struct nla_policy vport_policy[OVS_VPORT_ATTR_MAX + 1] = {
  1808. [OVS_VPORT_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
  1809. [OVS_VPORT_ATTR_STATS] = { .len = sizeof(struct ovs_vport_stats) },
  1810. [OVS_VPORT_ATTR_PORT_NO] = { .type = NLA_U32 },
  1811. [OVS_VPORT_ATTR_TYPE] = { .type = NLA_U32 },
  1812. [OVS_VPORT_ATTR_UPCALL_PID] = { .type = NLA_U32 },
  1813. [OVS_VPORT_ATTR_OPTIONS] = { .type = NLA_NESTED },
  1814. };
  1815. static const struct genl_ops dp_vport_genl_ops[] = {
  1816. { .cmd = OVS_VPORT_CMD_NEW,
  1817. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1818. .policy = vport_policy,
  1819. .doit = ovs_vport_cmd_new
  1820. },
  1821. { .cmd = OVS_VPORT_CMD_DEL,
  1822. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1823. .policy = vport_policy,
  1824. .doit = ovs_vport_cmd_del
  1825. },
  1826. { .cmd = OVS_VPORT_CMD_GET,
  1827. .flags = 0, /* OK for unprivileged users. */
  1828. .policy = vport_policy,
  1829. .doit = ovs_vport_cmd_get,
  1830. .dumpit = ovs_vport_cmd_dump
  1831. },
  1832. { .cmd = OVS_VPORT_CMD_SET,
  1833. .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
  1834. .policy = vport_policy,
  1835. .doit = ovs_vport_cmd_set,
  1836. },
  1837. };
  1838. struct genl_family dp_vport_genl_family = {
  1839. .id = GENL_ID_GENERATE,
  1840. .hdrsize = sizeof(struct ovs_header),
  1841. .name = OVS_VPORT_FAMILY,
  1842. .version = OVS_VPORT_VERSION,
  1843. .maxattr = OVS_VPORT_ATTR_MAX,
  1844. .netnsok = true,
  1845. .parallel_ops = true,
  1846. .ops = dp_vport_genl_ops,
  1847. .n_ops = ARRAY_SIZE(dp_vport_genl_ops),
  1848. .mcgrps = &ovs_dp_vport_multicast_group,
  1849. .n_mcgrps = 1,
  1850. };
  1851. static struct genl_family * const dp_genl_families[] = {
  1852. &dp_datapath_genl_family,
  1853. &dp_vport_genl_family,
  1854. &dp_flow_genl_family,
  1855. &dp_packet_genl_family,
  1856. };
  1857. static void dp_unregister_genl(int n_families)
  1858. {
  1859. int i;
  1860. for (i = 0; i < n_families; i++)
  1861. genl_unregister_family(dp_genl_families[i]);
  1862. }
  1863. static int dp_register_genl(void)
  1864. {
  1865. int err;
  1866. int i;
  1867. for (i = 0; i < ARRAY_SIZE(dp_genl_families); i++) {
  1868. err = genl_register_family(dp_genl_families[i]);
  1869. if (err)
  1870. goto error;
  1871. }
  1872. return 0;
  1873. error:
  1874. dp_unregister_genl(i);
  1875. return err;
  1876. }
  1877. static int __net_init ovs_init_net(struct net *net)
  1878. {
  1879. struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
  1880. INIT_LIST_HEAD(&ovs_net->dps);
  1881. INIT_WORK(&ovs_net->dp_notify_work, ovs_dp_notify_wq);
  1882. ovs_ct_init(net);
  1883. return 0;
  1884. }
  1885. static void __net_exit list_vports_from_net(struct net *net, struct net *dnet,
  1886. struct list_head *head)
  1887. {
  1888. struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
  1889. struct datapath *dp;
  1890. list_for_each_entry(dp, &ovs_net->dps, list_node) {
  1891. int i;
  1892. for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
  1893. struct vport *vport;
  1894. hlist_for_each_entry(vport, &dp->ports[i], dp_hash_node) {
  1895. if (vport->ops->type != OVS_VPORT_TYPE_INTERNAL)
  1896. continue;
  1897. if (dev_net(vport->dev) == dnet)
  1898. list_add(&vport->detach_list, head);
  1899. }
  1900. }
  1901. }
  1902. }
  1903. static void __net_exit ovs_exit_net(struct net *dnet)
  1904. {
  1905. struct datapath *dp, *dp_next;
  1906. struct ovs_net *ovs_net = net_generic(dnet, ovs_net_id);
  1907. struct vport *vport, *vport_next;
  1908. struct net *net;
  1909. LIST_HEAD(head);
  1910. ovs_ct_exit(dnet);
  1911. ovs_lock();
  1912. list_for_each_entry_safe(dp, dp_next, &ovs_net->dps, list_node)
  1913. __dp_destroy(dp);
  1914. rtnl_lock();
  1915. for_each_net(net)
  1916. list_vports_from_net(net, dnet, &head);
  1917. rtnl_unlock();
  1918. /* Detach all vports from given namespace. */
  1919. list_for_each_entry_safe(vport, vport_next, &head, detach_list) {
  1920. list_del(&vport->detach_list);
  1921. ovs_dp_detach_port(vport);
  1922. }
  1923. ovs_unlock();
  1924. cancel_work_sync(&ovs_net->dp_notify_work);
  1925. }
  1926. static struct pernet_operations ovs_net_ops = {
  1927. .init = ovs_init_net,
  1928. .exit = ovs_exit_net,
  1929. .id = &ovs_net_id,
  1930. .size = sizeof(struct ovs_net),
  1931. };
  1932. static int __init dp_init(void)
  1933. {
  1934. int err;
  1935. BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > FIELD_SIZEOF(struct sk_buff, cb));
  1936. pr_info("Open vSwitch switching datapath\n");
  1937. err = action_fifos_init();
  1938. if (err)
  1939. goto error;
  1940. err = ovs_internal_dev_rtnl_link_register();
  1941. if (err)
  1942. goto error_action_fifos_exit;
  1943. err = ovs_flow_init();
  1944. if (err)
  1945. goto error_unreg_rtnl_link;
  1946. err = ovs_vport_init();
  1947. if (err)
  1948. goto error_flow_exit;
  1949. err = register_pernet_device(&ovs_net_ops);
  1950. if (err)
  1951. goto error_vport_exit;
  1952. err = register_netdevice_notifier(&ovs_dp_device_notifier);
  1953. if (err)
  1954. goto error_netns_exit;
  1955. err = ovs_netdev_init();
  1956. if (err)
  1957. goto error_unreg_notifier;
  1958. err = dp_register_genl();
  1959. if (err < 0)
  1960. goto error_unreg_netdev;
  1961. return 0;
  1962. error_unreg_netdev:
  1963. ovs_netdev_exit();
  1964. error_unreg_notifier:
  1965. unregister_netdevice_notifier(&ovs_dp_device_notifier);
  1966. error_netns_exit:
  1967. unregister_pernet_device(&ovs_net_ops);
  1968. error_vport_exit:
  1969. ovs_vport_exit();
  1970. error_flow_exit:
  1971. ovs_flow_exit();
  1972. error_unreg_rtnl_link:
  1973. ovs_internal_dev_rtnl_link_unregister();
  1974. error_action_fifos_exit:
  1975. action_fifos_exit();
  1976. error:
  1977. return err;
  1978. }
  1979. static void dp_cleanup(void)
  1980. {
  1981. dp_unregister_genl(ARRAY_SIZE(dp_genl_families));
  1982. ovs_netdev_exit();
  1983. unregister_netdevice_notifier(&ovs_dp_device_notifier);
  1984. unregister_pernet_device(&ovs_net_ops);
  1985. rcu_barrier();
  1986. ovs_vport_exit();
  1987. ovs_flow_exit();
  1988. ovs_internal_dev_rtnl_link_unregister();
  1989. action_fifos_exit();
  1990. }
  1991. module_init(dp_init);
  1992. module_exit(dp_cleanup);
  1993. MODULE_DESCRIPTION("Open vSwitch switching datapath");
  1994. MODULE_LICENSE("GPL");