datapath.c 57 KB

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