rmnet_config.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800
  1. /* Copyright (c) 2013-2021, The Linux Foundation. All rights reserved.
  2. *
  3. * This program is free software; you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License version 2 and
  5. * only version 2 as published by the Free Software Foundation.
  6. *
  7. * This program is distributed in the hope that it will be useful,
  8. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. * GNU General Public License for more details.
  11. *
  12. * RMNET configuration engine
  13. *
  14. */
  15. #include <net/sock.h>
  16. #include <linux/module.h>
  17. #include <linux/netlink.h>
  18. #include <linux/netdevice.h>
  19. #include "rmnet_config.h"
  20. #include "rmnet_handlers.h"
  21. #include "rmnet_vnd.h"
  22. #include "rmnet_private.h"
  23. #include "rmnet_map.h"
  24. #include "rmnet_descriptor.h"
  25. #include "rmnet_ll.h"
  26. #include "rmnet_genl.h"
  27. #include "rmnet_qmi.h"
  28. #include "qmi_rmnet.h"
  29. #define CONFIG_QTI_QMI_RMNET 1
  30. #define CONFIG_QTI_QMI_DFC 1
  31. #define CONFIG_QTI_QMI_POWER_COLLAPSE 1
  32. #define QMAP_SHS_MASK 0xFF
  33. #define QMAP_SHS_PKT_LIMIT 200
  34. /* Locking scheme -
  35. * The shared resource which needs to be protected is realdev->rx_handler_data.
  36. * For the writer path, this is using rtnl_lock(). The writer paths are
  37. * rmnet_newlink(), rmnet_dellink() and rmnet_force_unassociate_device(). These
  38. * paths are already called with rtnl_lock() acquired in. There is also an
  39. * ASSERT_RTNL() to ensure that we are calling with rtnl acquired. For
  40. * dereference here, we will need to use rtnl_dereference(). Dev list writing
  41. * needs to happen with rtnl_lock() acquired for netdev_master_upper_dev_link().
  42. * For the reader path, the real_dev->rx_handler_data is called in the TX / RX
  43. * path. We only need rcu_read_lock() for these scenarios. In these cases,
  44. * the rcu_read_lock() is held in __dev_queue_xmit() and
  45. * netif_receive_skb_internal(), so readers need to use rcu_dereference_rtnl()
  46. * to get the relevant information. For dev list reading, we again acquire
  47. * rcu_read_lock() in rmnet_dellink() for netdev_master_upper_dev_get_rcu().
  48. * We also use unregister_netdevice_many() to free all rmnet devices in
  49. * rmnet_force_unassociate_device() so we dont lose the rtnl_lock() and free in
  50. * same context.
  51. */
  52. /* Local Definitions and Declarations */
  53. enum {
  54. IFLA_RMNET_DFC_QOS = __IFLA_RMNET_MAX,
  55. IFLA_RMNET_UL_AGG_PARAMS,
  56. __IFLA_RMNET_EXT_MAX,
  57. };
  58. static const struct nla_policy rmnet_policy[__IFLA_RMNET_EXT_MAX] = {
  59. [IFLA_RMNET_MUX_ID] = {
  60. .type = NLA_U16
  61. },
  62. [IFLA_RMNET_FLAGS] = {
  63. .len = sizeof(struct ifla_rmnet_flags)
  64. },
  65. [IFLA_RMNET_DFC_QOS] = {
  66. .len = sizeof(struct tcmsg)
  67. },
  68. [IFLA_RMNET_UL_AGG_PARAMS] = {
  69. .len = sizeof(struct rmnet_egress_agg_params)
  70. },
  71. };
  72. int rmnet_is_real_dev_registered(const struct net_device *real_dev)
  73. {
  74. return rcu_access_pointer(real_dev->rx_handler) == rmnet_rx_handler;
  75. }
  76. EXPORT_SYMBOL(rmnet_is_real_dev_registered);
  77. /* Needs rtnl lock */
  78. static struct rmnet_port*
  79. rmnet_get_port_rtnl(const struct net_device *real_dev)
  80. {
  81. return rtnl_dereference(real_dev->rx_handler_data);
  82. }
  83. static int rmnet_unregister_real_device(struct net_device *real_dev,
  84. struct rmnet_port *port)
  85. {
  86. if (port->nr_rmnet_devs)
  87. return -EINVAL;
  88. netdev_rx_handler_unregister(real_dev);
  89. rmnet_map_cmd_exit(port);
  90. rmnet_map_tx_aggregate_exit(port);
  91. rmnet_descriptor_deinit(port);
  92. kfree(port);
  93. /* release reference on real_dev */
  94. dev_put(real_dev);
  95. netdev_dbg(real_dev, "Removed from rmnet\n");
  96. return 0;
  97. }
  98. static int rmnet_register_real_device(struct net_device *real_dev)
  99. {
  100. struct rmnet_port *port;
  101. int rc, entry;
  102. ASSERT_RTNL();
  103. if (rmnet_is_real_dev_registered(real_dev))
  104. return 0;
  105. port = kzalloc(sizeof(*port), GFP_ATOMIC);
  106. if (!port)
  107. return -ENOMEM;
  108. port->dev = real_dev;
  109. port->phy_shs_cfg.config = RMNET_SHS_NO_DLMKR | RMNET_SHS_NO_PSH |
  110. RMNET_SHS_STMP_ALL;
  111. port->phy_shs_cfg.map_mask = QMAP_SHS_MASK;
  112. port->phy_shs_cfg.max_pkts = QMAP_SHS_PKT_LIMIT;
  113. rc = netdev_rx_handler_register(real_dev, rmnet_rx_handler, port);
  114. if (rc) {
  115. kfree(port);
  116. return -EBUSY;
  117. }
  118. /* hold on to real dev for MAP data */
  119. dev_hold(real_dev);
  120. for (entry = 0; entry < RMNET_MAX_LOGICAL_EP; entry++)
  121. INIT_HLIST_HEAD(&port->muxed_ep[entry]);
  122. rc = rmnet_descriptor_init(port);
  123. if (rc) {
  124. rmnet_descriptor_deinit(port);
  125. return rc;
  126. }
  127. rmnet_map_tx_aggregate_init(port);
  128. rmnet_map_cmd_init(port);
  129. netdev_dbg(real_dev, "registered with rmnet\n");
  130. return 0;
  131. }
  132. static void rmnet_unregister_bridge(struct net_device *dev,
  133. struct rmnet_port *port)
  134. {
  135. struct rmnet_port *bridge_port;
  136. struct net_device *bridge_dev;
  137. if (port->rmnet_mode != RMNET_EPMODE_BRIDGE)
  138. return;
  139. /* bridge slave handling */
  140. if (!port->nr_rmnet_devs) {
  141. bridge_dev = port->bridge_ep;
  142. bridge_port = rmnet_get_port_rtnl(bridge_dev);
  143. bridge_port->bridge_ep = NULL;
  144. bridge_port->rmnet_mode = RMNET_EPMODE_VND;
  145. } else {
  146. bridge_dev = port->bridge_ep;
  147. bridge_port = rmnet_get_port_rtnl(bridge_dev);
  148. rmnet_unregister_real_device(bridge_dev, bridge_port);
  149. }
  150. }
  151. static int rmnet_newlink(struct net *src_net, struct net_device *dev,
  152. struct nlattr *tb[], struct nlattr *data[],
  153. struct netlink_ext_ack *extack)
  154. {
  155. struct net_device *real_dev;
  156. int mode = RMNET_EPMODE_VND;
  157. struct rmnet_endpoint *ep;
  158. struct rmnet_port *port;
  159. u32 data_format;
  160. int err = 0;
  161. u16 mux_id;
  162. real_dev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
  163. if (!real_dev || !dev)
  164. return -ENODEV;
  165. if (!data[IFLA_RMNET_MUX_ID])
  166. return -EINVAL;
  167. ep = kzalloc(sizeof(*ep), GFP_ATOMIC);
  168. if (!ep)
  169. return -ENOMEM;
  170. mux_id = nla_get_u16(data[IFLA_RMNET_MUX_ID]);
  171. err = rmnet_register_real_device(real_dev);
  172. if (err)
  173. goto err0;
  174. port = rmnet_get_port_rtnl(real_dev);
  175. err = rmnet_vnd_newlink(mux_id, dev, port, real_dev, ep);
  176. if (err)
  177. goto err1;
  178. port->rmnet_mode = mode;
  179. hlist_add_head_rcu(&ep->hlnode, &port->muxed_ep[mux_id]);
  180. if (data[IFLA_RMNET_FLAGS]) {
  181. struct ifla_rmnet_flags *flags;
  182. flags = nla_data(data[IFLA_RMNET_FLAGS]);
  183. data_format = flags->flags & flags->mask;
  184. netdev_dbg(dev, "data format [0x%08X]\n", data_format);
  185. port->data_format = data_format;
  186. }
  187. if (data[IFLA_RMNET_UL_AGG_PARAMS]) {
  188. void *agg_params;
  189. unsigned long irq_flags;
  190. agg_params = nla_data(data[IFLA_RMNET_UL_AGG_PARAMS]);
  191. spin_lock_irqsave(&port->agg_lock, irq_flags);
  192. memcpy(&port->egress_agg_params, agg_params,
  193. sizeof(port->egress_agg_params));
  194. spin_unlock_irqrestore(&port->agg_lock, irq_flags);
  195. }
  196. return 0;
  197. err1:
  198. rmnet_unregister_real_device(real_dev, port);
  199. err0:
  200. kfree(ep);
  201. return err;
  202. }
  203. static void rmnet_dellink(struct net_device *dev, struct list_head *head)
  204. {
  205. struct rmnet_priv *priv = netdev_priv(dev);
  206. struct net_device *real_dev;
  207. struct rmnet_endpoint *ep;
  208. struct rmnet_port *port;
  209. u8 mux_id;
  210. real_dev = priv->real_dev;
  211. if (!real_dev || !rmnet_is_real_dev_registered(real_dev))
  212. return;
  213. port = rmnet_get_port_rtnl(real_dev);
  214. mux_id = rmnet_vnd_get_mux(dev);
  215. ep = rmnet_get_endpoint(port, mux_id);
  216. if (ep) {
  217. hlist_del_init_rcu(&ep->hlnode);
  218. rmnet_unregister_bridge(dev, port);
  219. rmnet_vnd_dellink(mux_id, port, ep);
  220. synchronize_rcu();
  221. kfree(ep);
  222. }
  223. if (!port->nr_rmnet_devs)
  224. qmi_rmnet_qmi_exit(port->qmi_info, port);
  225. unregister_netdevice(dev);
  226. qmi_rmnet_qos_exit_post();
  227. rmnet_unregister_real_device(real_dev, port);
  228. }
  229. static void rmnet_force_unassociate_device(struct net_device *dev)
  230. {
  231. struct net_device *real_dev = dev;
  232. struct hlist_node *tmp_ep;
  233. struct rmnet_endpoint *ep;
  234. struct rmnet_port *port;
  235. unsigned long bkt_ep;
  236. LIST_HEAD(list);
  237. HLIST_HEAD(cleanup_list);
  238. if (!rmnet_is_real_dev_registered(real_dev))
  239. return;
  240. ASSERT_RTNL();
  241. port = rmnet_get_port_rtnl(dev);
  242. qmi_rmnet_qmi_exit(port->qmi_info, port);
  243. rmnet_unregister_bridge(dev, port);
  244. hash_for_each_safe(port->muxed_ep, bkt_ep, tmp_ep, ep, hlnode) {
  245. unregister_netdevice_queue(ep->egress_dev, &list);
  246. rmnet_vnd_dellink(ep->mux_id, port, ep);
  247. hlist_del_init_rcu(&ep->hlnode);
  248. hlist_add_head(&ep->hlnode, &cleanup_list);
  249. }
  250. synchronize_rcu();
  251. hlist_for_each_entry_safe(ep, tmp_ep, &cleanup_list, hlnode) {
  252. hlist_del(&ep->hlnode);
  253. kfree(ep);
  254. }
  255. /* Unregistering devices in context before freeing port.
  256. * If this API becomes non-context their order should switch.
  257. */
  258. unregister_netdevice_many(&list);
  259. qmi_rmnet_qos_exit_post();
  260. rmnet_unregister_real_device(real_dev, port);
  261. }
  262. static int rmnet_config_notify_cb(struct notifier_block *nb,
  263. unsigned long event, void *data)
  264. {
  265. struct net_device *dev = netdev_notifier_info_to_dev(data);
  266. if (!dev)
  267. return NOTIFY_DONE;
  268. switch (event) {
  269. case NETDEV_UNREGISTER:
  270. netdev_dbg(dev, "Kernel unregister\n");
  271. rmnet_force_unassociate_device(dev);
  272. break;
  273. case NETDEV_DOWN:
  274. rmnet_vnd_reset_mac_addr(dev);
  275. break;
  276. default:
  277. break;
  278. }
  279. return NOTIFY_DONE;
  280. }
  281. static struct notifier_block rmnet_dev_notifier __read_mostly = {
  282. .notifier_call = rmnet_config_notify_cb,
  283. };
  284. static int rmnet_rtnl_validate(struct nlattr *tb[], struct nlattr *data[],
  285. struct netlink_ext_ack *extack)
  286. {
  287. struct rmnet_egress_agg_params *agg_params;
  288. u16 mux_id;
  289. if (!data) {
  290. return -EINVAL;
  291. } else {
  292. if (data[IFLA_RMNET_MUX_ID]) {
  293. mux_id = nla_get_u16(data[IFLA_RMNET_MUX_ID]);
  294. if (mux_id > (RMNET_MAX_LOGICAL_EP - 1))
  295. return -ERANGE;
  296. }
  297. if (data[IFLA_RMNET_UL_AGG_PARAMS]) {
  298. agg_params = nla_data(data[IFLA_RMNET_UL_AGG_PARAMS]);
  299. if (agg_params->agg_time < 1000000)
  300. return -EINVAL;
  301. }
  302. }
  303. return 0;
  304. }
  305. static int rmnet_changelink(struct net_device *dev, struct nlattr *tb[],
  306. struct nlattr *data[],
  307. struct netlink_ext_ack *extack)
  308. {
  309. struct rmnet_priv *priv = netdev_priv(dev);
  310. struct net_device *real_dev;
  311. struct rmnet_endpoint *ep;
  312. struct rmnet_port *port;
  313. u16 mux_id;
  314. real_dev = __dev_get_by_index(dev_net(dev),
  315. nla_get_u32(tb[IFLA_LINK]));
  316. if (!real_dev || !dev || !rmnet_is_real_dev_registered(real_dev))
  317. return -ENODEV;
  318. port = rmnet_get_port_rtnl(real_dev);
  319. if (data[IFLA_RMNET_MUX_ID]) {
  320. mux_id = nla_get_u16(data[IFLA_RMNET_MUX_ID]);
  321. ep = rmnet_get_endpoint(port, priv->mux_id);
  322. if (!ep)
  323. return -ENODEV;
  324. hlist_del_init_rcu(&ep->hlnode);
  325. hlist_add_head_rcu(&ep->hlnode, &port->muxed_ep[mux_id]);
  326. ep->mux_id = mux_id;
  327. priv->mux_id = mux_id;
  328. }
  329. if (data[IFLA_RMNET_FLAGS]) {
  330. struct ifla_rmnet_flags *flags;
  331. flags = nla_data(data[IFLA_RMNET_FLAGS]);
  332. port->data_format = flags->flags & flags->mask;
  333. }
  334. if (data[IFLA_RMNET_DFC_QOS]) {
  335. struct nlattr *qos = data[IFLA_RMNET_DFC_QOS];
  336. struct tcmsg *tcm;
  337. tcm = nla_data(qos);
  338. qmi_rmnet_change_link(dev, port, tcm, nla_len(qos));
  339. }
  340. if (data[IFLA_RMNET_UL_AGG_PARAMS]) {
  341. struct rmnet_egress_agg_params *agg_params;
  342. agg_params = nla_data(data[IFLA_RMNET_UL_AGG_PARAMS]);
  343. rmnet_map_update_ul_agg_config(port, agg_params->agg_size,
  344. agg_params->agg_count,
  345. agg_params->agg_features,
  346. agg_params->agg_time);
  347. }
  348. return 0;
  349. }
  350. static size_t rmnet_get_size(const struct net_device *dev)
  351. {
  352. return
  353. /* IFLA_RMNET_MUX_ID */
  354. nla_total_size(2) +
  355. /* IFLA_RMNET_FLAGS */
  356. nla_total_size(sizeof(struct ifla_rmnet_flags)) +
  357. /* IFLA_RMNET_DFC_QOS */
  358. nla_total_size(sizeof(struct tcmsg)) +
  359. /* IFLA_RMNET_UL_AGG_PARAMS */
  360. nla_total_size(sizeof(struct rmnet_egress_agg_params));
  361. }
  362. static int rmnet_fill_info(struct sk_buff *skb, const struct net_device *dev)
  363. {
  364. struct rmnet_priv *priv = netdev_priv(dev);
  365. struct net_device *real_dev;
  366. struct ifla_rmnet_flags f;
  367. struct rmnet_port *port = NULL;
  368. real_dev = priv->real_dev;
  369. if (nla_put_u16(skb, IFLA_RMNET_MUX_ID, priv->mux_id))
  370. goto nla_put_failure;
  371. if (rmnet_is_real_dev_registered(real_dev)) {
  372. port = rmnet_get_port_rtnl(real_dev);
  373. f.flags = port->data_format;
  374. } else {
  375. f.flags = 0;
  376. }
  377. f.mask = ~0;
  378. if (nla_put(skb, IFLA_RMNET_FLAGS, sizeof(f), &f))
  379. goto nla_put_failure;
  380. if (port) {
  381. if (nla_put(skb, IFLA_RMNET_UL_AGG_PARAMS,
  382. sizeof(port->egress_agg_params),
  383. &port->egress_agg_params))
  384. goto nla_put_failure;
  385. }
  386. return 0;
  387. nla_put_failure:
  388. return -EMSGSIZE;
  389. }
  390. struct rtnl_link_ops rmnet_link_ops __read_mostly = {
  391. .kind = "rmnet",
  392. .maxtype = __IFLA_RMNET_EXT_MAX,
  393. .priv_size = sizeof(struct rmnet_priv),
  394. .setup = rmnet_vnd_setup,
  395. .validate = rmnet_rtnl_validate,
  396. .newlink = rmnet_newlink,
  397. .dellink = rmnet_dellink,
  398. .get_size = rmnet_get_size,
  399. .changelink = rmnet_changelink,
  400. .policy = rmnet_policy,
  401. .fill_info = rmnet_fill_info,
  402. };
  403. /* Needs either rcu_read_lock() or rtnl lock */
  404. struct rmnet_port *rmnet_get_port(struct net_device *real_dev)
  405. {
  406. if (rmnet_is_real_dev_registered(real_dev))
  407. return rcu_dereference_rtnl(real_dev->rx_handler_data);
  408. else
  409. return NULL;
  410. }
  411. EXPORT_SYMBOL(rmnet_get_port);
  412. struct rmnet_endpoint *rmnet_get_endpoint(struct rmnet_port *port, u8 mux_id)
  413. {
  414. struct rmnet_endpoint *ep;
  415. hlist_for_each_entry_rcu(ep, &port->muxed_ep[mux_id], hlnode) {
  416. if (ep->mux_id == mux_id)
  417. return ep;
  418. }
  419. return NULL;
  420. }
  421. EXPORT_SYMBOL(rmnet_get_endpoint);
  422. int rmnet_add_bridge(struct net_device *rmnet_dev,
  423. struct net_device *slave_dev,
  424. struct netlink_ext_ack *extack)
  425. {
  426. struct rmnet_priv *priv = netdev_priv(rmnet_dev);
  427. struct net_device *real_dev = priv->real_dev;
  428. struct rmnet_port *port, *slave_port;
  429. int err;
  430. port = rmnet_get_port(real_dev);
  431. /* If there is more than one rmnet dev attached, its probably being
  432. * used for muxing. Skip the briding in that case
  433. */
  434. if (port->nr_rmnet_devs > 1)
  435. return -EINVAL;
  436. if (rmnet_is_real_dev_registered(slave_dev))
  437. return -EBUSY;
  438. err = rmnet_register_real_device(slave_dev);
  439. if (err)
  440. return -EBUSY;
  441. slave_port = rmnet_get_port(slave_dev);
  442. slave_port->rmnet_mode = RMNET_EPMODE_BRIDGE;
  443. slave_port->bridge_ep = real_dev;
  444. port->rmnet_mode = RMNET_EPMODE_BRIDGE;
  445. port->bridge_ep = slave_dev;
  446. netdev_dbg(slave_dev, "registered with rmnet as slave\n");
  447. return 0;
  448. }
  449. int rmnet_del_bridge(struct net_device *rmnet_dev,
  450. struct net_device *slave_dev)
  451. {
  452. struct rmnet_priv *priv = netdev_priv(rmnet_dev);
  453. struct net_device *real_dev = priv->real_dev;
  454. struct rmnet_port *port, *slave_port;
  455. port = rmnet_get_port(real_dev);
  456. port->rmnet_mode = RMNET_EPMODE_VND;
  457. port->bridge_ep = NULL;
  458. slave_port = rmnet_get_port(slave_dev);
  459. rmnet_unregister_real_device(slave_dev, slave_port);
  460. netdev_dbg(slave_dev, "removed from rmnet as slave\n");
  461. return 0;
  462. }
  463. void *rmnet_get_qmi_pt(void *port)
  464. {
  465. if (port)
  466. return ((struct rmnet_port *)port)->qmi_info;
  467. return NULL;
  468. }
  469. EXPORT_SYMBOL(rmnet_get_qmi_pt);
  470. void *rmnet_get_qos_pt(struct net_device *dev)
  471. {
  472. struct rmnet_priv *priv;
  473. if (dev) {
  474. priv = netdev_priv(dev);
  475. return rcu_dereference(priv->qos_info);
  476. }
  477. return NULL;
  478. }
  479. EXPORT_SYMBOL(rmnet_get_qos_pt);
  480. void *rmnet_get_rmnet_port(struct net_device *dev)
  481. {
  482. struct rmnet_priv *priv;
  483. if (dev) {
  484. priv = netdev_priv(dev);
  485. return (void *)rmnet_get_port(priv->real_dev);
  486. }
  487. return NULL;
  488. }
  489. EXPORT_SYMBOL(rmnet_get_rmnet_port);
  490. struct net_device *rmnet_get_rmnet_dev(void *port, u8 mux_id)
  491. {
  492. struct rmnet_endpoint *ep;
  493. if (port) {
  494. ep = rmnet_get_endpoint((struct rmnet_port *)port, mux_id);
  495. if (ep)
  496. return ep->egress_dev;
  497. }
  498. return NULL;
  499. }
  500. EXPORT_SYMBOL(rmnet_get_rmnet_dev);
  501. void rmnet_reset_qmi_pt(void *port)
  502. {
  503. if (port)
  504. ((struct rmnet_port *)port)->qmi_info = NULL;
  505. }
  506. EXPORT_SYMBOL(rmnet_reset_qmi_pt);
  507. void rmnet_init_qmi_pt(void *port, void *qmi)
  508. {
  509. if (port)
  510. ((struct rmnet_port *)port)->qmi_info = qmi;
  511. }
  512. EXPORT_SYMBOL(rmnet_init_qmi_pt);
  513. void rmnet_get_packets(void *port, u64 *rx, u64 *tx)
  514. {
  515. struct rmnet_priv *priv;
  516. struct rmnet_pcpu_stats *ps;
  517. unsigned int cpu, start;
  518. struct rmnet_endpoint *ep;
  519. unsigned long bkt;
  520. if (!port || !tx || !rx)
  521. return;
  522. *tx = 0;
  523. *rx = 0;
  524. rcu_read_lock();
  525. hash_for_each(((struct rmnet_port *)port)->muxed_ep, bkt, ep, hlnode) {
  526. priv = netdev_priv(ep->egress_dev);
  527. for_each_possible_cpu(cpu) {
  528. ps = per_cpu_ptr(priv->pcpu_stats, cpu);
  529. do {
  530. start = u64_stats_fetch_begin_irq(&ps->syncp);
  531. *tx += ps->stats.tx_pkts;
  532. *rx += ps->stats.rx_pkts;
  533. } while (u64_stats_fetch_retry_irq(&ps->syncp, start));
  534. }
  535. }
  536. rcu_read_unlock();
  537. }
  538. EXPORT_SYMBOL(rmnet_get_packets);
  539. void rmnet_set_powersave_format(void *port)
  540. {
  541. if (!port)
  542. return;
  543. ((struct rmnet_port *)port)->data_format |= RMNET_INGRESS_FORMAT_PS;
  544. }
  545. EXPORT_SYMBOL(rmnet_set_powersave_format);
  546. void rmnet_clear_powersave_format(void *port)
  547. {
  548. if (!port)
  549. return;
  550. ((struct rmnet_port *)port)->data_format &= ~RMNET_INGRESS_FORMAT_PS;
  551. }
  552. EXPORT_SYMBOL(rmnet_clear_powersave_format);
  553. void rmnet_enable_all_flows(void *port)
  554. {
  555. struct rmnet_endpoint *ep;
  556. unsigned long bkt;
  557. if (unlikely(!port))
  558. return;
  559. rcu_read_lock();
  560. hash_for_each_rcu(((struct rmnet_port *)port)->muxed_ep,
  561. bkt, ep, hlnode) {
  562. qmi_rmnet_enable_all_flows(ep->egress_dev);
  563. }
  564. rcu_read_unlock();
  565. }
  566. EXPORT_SYMBOL(rmnet_enable_all_flows);
  567. bool rmnet_all_flows_enabled(void *port)
  568. {
  569. struct rmnet_endpoint *ep;
  570. unsigned long bkt;
  571. bool ret = true;
  572. if (unlikely(!port))
  573. return true;
  574. rcu_read_lock();
  575. hash_for_each_rcu(((struct rmnet_port *)port)->muxed_ep,
  576. bkt, ep, hlnode) {
  577. if (!qmi_rmnet_all_flows_enabled(ep->egress_dev)) {
  578. ret = false;
  579. goto out;
  580. }
  581. }
  582. out:
  583. rcu_read_unlock();
  584. return ret;
  585. }
  586. EXPORT_SYMBOL(rmnet_all_flows_enabled);
  587. int rmnet_get_powersave_notif(void *port)
  588. {
  589. if (!port)
  590. return 0;
  591. return ((struct rmnet_port *)port)->data_format & RMNET_FORMAT_PS_NOTIF;
  592. }
  593. EXPORT_SYMBOL(rmnet_get_powersave_notif);
  594. struct net_device *rmnet_get_real_dev(void *port)
  595. {
  596. if (port)
  597. return ((struct rmnet_port *)port)->dev;
  598. return NULL;
  599. }
  600. EXPORT_SYMBOL(rmnet_get_real_dev);
  601. int rmnet_get_dlmarker_info(void *port)
  602. {
  603. if (!port)
  604. return 0;
  605. return ((struct rmnet_port *)port)->data_format &
  606. (RMNET_INGRESS_FORMAT_DL_MARKER_V1 |
  607. RMNET_INGRESS_FORMAT_DL_MARKER_V2);
  608. }
  609. EXPORT_SYMBOL(rmnet_get_dlmarker_info);
  610. /* Startup/Shutdown */
  611. static int __init rmnet_init(void)
  612. {
  613. int rc;
  614. rc = register_netdevice_notifier(&rmnet_dev_notifier);
  615. if (rc != 0)
  616. return rc;
  617. rc = rtnl_link_register(&rmnet_link_ops);
  618. if (rc != 0) {
  619. unregister_netdevice_notifier(&rmnet_dev_notifier);
  620. return rc;
  621. }
  622. rc = rmnet_ll_init();
  623. if (rc != 0) {
  624. unregister_netdevice_notifier(&rmnet_dev_notifier);
  625. rtnl_link_unregister(&rmnet_link_ops);
  626. return rc;
  627. }
  628. rmnet_core_genl_init();
  629. try_module_get(THIS_MODULE);
  630. return rc;
  631. }
  632. static void __exit rmnet_exit(void)
  633. {
  634. unregister_netdevice_notifier(&rmnet_dev_notifier);
  635. rtnl_link_unregister(&rmnet_link_ops);
  636. rmnet_ll_exit();
  637. rmnet_core_genl_deinit();
  638. module_put(THIS_MODULE);
  639. }
  640. module_init(rmnet_init)
  641. module_exit(rmnet_exit)
  642. MODULE_LICENSE("GPL v2");