datapath.c 57 KB

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