datapath.c 57 KB

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