ethtool.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966
  1. /*
  2. * net/core/ethtool.c - Ethtool ioctl handler
  3. * Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx>
  4. *
  5. * This file is where we call all the ethtool_ops commands to get
  6. * the information ethtool needs. We fall back to calling do_ioctl()
  7. * for drivers which haven't been converted to ethtool_ops yet.
  8. *
  9. * It's GPL, stupid.
  10. */
  11. #include <linux/module.h>
  12. #include <linux/types.h>
  13. #include <linux/capability.h>
  14. #include <linux/errno.h>
  15. #include <linux/ethtool.h>
  16. #include <linux/netdevice.h>
  17. #include <asm/uaccess.h>
  18. /*
  19. * Some useful ethtool_ops methods that're device independent.
  20. * If we find that all drivers want to do the same thing here,
  21. * we can turn these into dev_() function calls.
  22. */
  23. u32 ethtool_op_get_link(struct net_device *dev)
  24. {
  25. return netif_carrier_ok(dev) ? 1 : 0;
  26. }
  27. u32 ethtool_op_get_tx_csum(struct net_device *dev)
  28. {
  29. return (dev->features & NETIF_F_ALL_CSUM) != 0;
  30. }
  31. int ethtool_op_set_tx_csum(struct net_device *dev, u32 data)
  32. {
  33. if (data)
  34. dev->features |= NETIF_F_IP_CSUM;
  35. else
  36. dev->features &= ~NETIF_F_IP_CSUM;
  37. return 0;
  38. }
  39. int ethtool_op_set_tx_hw_csum(struct net_device *dev, u32 data)
  40. {
  41. if (data)
  42. dev->features |= NETIF_F_HW_CSUM;
  43. else
  44. dev->features &= ~NETIF_F_HW_CSUM;
  45. return 0;
  46. }
  47. u32 ethtool_op_get_sg(struct net_device *dev)
  48. {
  49. return (dev->features & NETIF_F_SG) != 0;
  50. }
  51. int ethtool_op_set_sg(struct net_device *dev, u32 data)
  52. {
  53. if (data)
  54. dev->features |= NETIF_F_SG;
  55. else
  56. dev->features &= ~NETIF_F_SG;
  57. return 0;
  58. }
  59. u32 ethtool_op_get_tso(struct net_device *dev)
  60. {
  61. return (dev->features & NETIF_F_TSO) != 0;
  62. }
  63. int ethtool_op_set_tso(struct net_device *dev, u32 data)
  64. {
  65. if (data)
  66. dev->features |= NETIF_F_TSO;
  67. else
  68. dev->features &= ~NETIF_F_TSO;
  69. return 0;
  70. }
  71. int ethtool_op_get_perm_addr(struct net_device *dev, struct ethtool_perm_addr *addr, u8 *data)
  72. {
  73. unsigned char len = dev->addr_len;
  74. if ( addr->size < len )
  75. return -ETOOSMALL;
  76. addr->size = len;
  77. memcpy(data, dev->perm_addr, len);
  78. return 0;
  79. }
  80. u32 ethtool_op_get_ufo(struct net_device *dev)
  81. {
  82. return (dev->features & NETIF_F_UFO) != 0;
  83. }
  84. int ethtool_op_set_ufo(struct net_device *dev, u32 data)
  85. {
  86. if (data)
  87. dev->features |= NETIF_F_UFO;
  88. else
  89. dev->features &= ~NETIF_F_UFO;
  90. return 0;
  91. }
  92. /* Handlers for each ethtool command */
  93. static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
  94. {
  95. struct ethtool_cmd cmd = { ETHTOOL_GSET };
  96. int err;
  97. if (!dev->ethtool_ops->get_settings)
  98. return -EOPNOTSUPP;
  99. err = dev->ethtool_ops->get_settings(dev, &cmd);
  100. if (err < 0)
  101. return err;
  102. if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
  103. return -EFAULT;
  104. return 0;
  105. }
  106. static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
  107. {
  108. struct ethtool_cmd cmd;
  109. if (!dev->ethtool_ops->set_settings)
  110. return -EOPNOTSUPP;
  111. if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
  112. return -EFAULT;
  113. return dev->ethtool_ops->set_settings(dev, &cmd);
  114. }
  115. static int ethtool_get_drvinfo(struct net_device *dev, void __user *useraddr)
  116. {
  117. struct ethtool_drvinfo info;
  118. const struct ethtool_ops *ops = dev->ethtool_ops;
  119. if (!ops->get_drvinfo)
  120. return -EOPNOTSUPP;
  121. memset(&info, 0, sizeof(info));
  122. info.cmd = ETHTOOL_GDRVINFO;
  123. ops->get_drvinfo(dev, &info);
  124. if (ops->self_test_count)
  125. info.testinfo_len = ops->self_test_count(dev);
  126. if (ops->get_stats_count)
  127. info.n_stats = ops->get_stats_count(dev);
  128. if (ops->get_regs_len)
  129. info.regdump_len = ops->get_regs_len(dev);
  130. if (ops->get_eeprom_len)
  131. info.eedump_len = ops->get_eeprom_len(dev);
  132. if (copy_to_user(useraddr, &info, sizeof(info)))
  133. return -EFAULT;
  134. return 0;
  135. }
  136. static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
  137. {
  138. struct ethtool_regs regs;
  139. const struct ethtool_ops *ops = dev->ethtool_ops;
  140. void *regbuf;
  141. int reglen, ret;
  142. if (!ops->get_regs || !ops->get_regs_len)
  143. return -EOPNOTSUPP;
  144. if (copy_from_user(&regs, useraddr, sizeof(regs)))
  145. return -EFAULT;
  146. reglen = ops->get_regs_len(dev);
  147. if (regs.len > reglen)
  148. regs.len = reglen;
  149. regbuf = kmalloc(reglen, GFP_USER);
  150. if (!regbuf)
  151. return -ENOMEM;
  152. ops->get_regs(dev, &regs, regbuf);
  153. ret = -EFAULT;
  154. if (copy_to_user(useraddr, &regs, sizeof(regs)))
  155. goto out;
  156. useraddr += offsetof(struct ethtool_regs, data);
  157. if (copy_to_user(useraddr, regbuf, regs.len))
  158. goto out;
  159. ret = 0;
  160. out:
  161. kfree(regbuf);
  162. return ret;
  163. }
  164. static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
  165. {
  166. struct ethtool_wolinfo wol = { ETHTOOL_GWOL };
  167. if (!dev->ethtool_ops->get_wol)
  168. return -EOPNOTSUPP;
  169. dev->ethtool_ops->get_wol(dev, &wol);
  170. if (copy_to_user(useraddr, &wol, sizeof(wol)))
  171. return -EFAULT;
  172. return 0;
  173. }
  174. static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
  175. {
  176. struct ethtool_wolinfo wol;
  177. if (!dev->ethtool_ops->set_wol)
  178. return -EOPNOTSUPP;
  179. if (copy_from_user(&wol, useraddr, sizeof(wol)))
  180. return -EFAULT;
  181. return dev->ethtool_ops->set_wol(dev, &wol);
  182. }
  183. static int ethtool_get_msglevel(struct net_device *dev, char __user *useraddr)
  184. {
  185. struct ethtool_value edata = { ETHTOOL_GMSGLVL };
  186. if (!dev->ethtool_ops->get_msglevel)
  187. return -EOPNOTSUPP;
  188. edata.data = dev->ethtool_ops->get_msglevel(dev);
  189. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  190. return -EFAULT;
  191. return 0;
  192. }
  193. static int ethtool_set_msglevel(struct net_device *dev, char __user *useraddr)
  194. {
  195. struct ethtool_value edata;
  196. if (!dev->ethtool_ops->set_msglevel)
  197. return -EOPNOTSUPP;
  198. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  199. return -EFAULT;
  200. dev->ethtool_ops->set_msglevel(dev, edata.data);
  201. return 0;
  202. }
  203. static int ethtool_nway_reset(struct net_device *dev)
  204. {
  205. if (!dev->ethtool_ops->nway_reset)
  206. return -EOPNOTSUPP;
  207. return dev->ethtool_ops->nway_reset(dev);
  208. }
  209. static int ethtool_get_link(struct net_device *dev, void __user *useraddr)
  210. {
  211. struct ethtool_value edata = { ETHTOOL_GLINK };
  212. if (!dev->ethtool_ops->get_link)
  213. return -EOPNOTSUPP;
  214. edata.data = dev->ethtool_ops->get_link(dev);
  215. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  216. return -EFAULT;
  217. return 0;
  218. }
  219. static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
  220. {
  221. struct ethtool_eeprom eeprom;
  222. const struct ethtool_ops *ops = dev->ethtool_ops;
  223. u8 *data;
  224. int ret;
  225. if (!ops->get_eeprom || !ops->get_eeprom_len)
  226. return -EOPNOTSUPP;
  227. if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
  228. return -EFAULT;
  229. /* Check for wrap and zero */
  230. if (eeprom.offset + eeprom.len <= eeprom.offset)
  231. return -EINVAL;
  232. /* Check for exceeding total eeprom len */
  233. if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
  234. return -EINVAL;
  235. data = kmalloc(eeprom.len, GFP_USER);
  236. if (!data)
  237. return -ENOMEM;
  238. ret = -EFAULT;
  239. if (copy_from_user(data, useraddr + sizeof(eeprom), eeprom.len))
  240. goto out;
  241. ret = ops->get_eeprom(dev, &eeprom, data);
  242. if (ret)
  243. goto out;
  244. ret = -EFAULT;
  245. if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
  246. goto out;
  247. if (copy_to_user(useraddr + sizeof(eeprom), data, eeprom.len))
  248. goto out;
  249. ret = 0;
  250. out:
  251. kfree(data);
  252. return ret;
  253. }
  254. static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
  255. {
  256. struct ethtool_eeprom eeprom;
  257. const struct ethtool_ops *ops = dev->ethtool_ops;
  258. u8 *data;
  259. int ret;
  260. if (!ops->set_eeprom || !ops->get_eeprom_len)
  261. return -EOPNOTSUPP;
  262. if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
  263. return -EFAULT;
  264. /* Check for wrap and zero */
  265. if (eeprom.offset + eeprom.len <= eeprom.offset)
  266. return -EINVAL;
  267. /* Check for exceeding total eeprom len */
  268. if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
  269. return -EINVAL;
  270. data = kmalloc(eeprom.len, GFP_USER);
  271. if (!data)
  272. return -ENOMEM;
  273. ret = -EFAULT;
  274. if (copy_from_user(data, useraddr + sizeof(eeprom), eeprom.len))
  275. goto out;
  276. ret = ops->set_eeprom(dev, &eeprom, data);
  277. if (ret)
  278. goto out;
  279. if (copy_to_user(useraddr + sizeof(eeprom), data, eeprom.len))
  280. ret = -EFAULT;
  281. out:
  282. kfree(data);
  283. return ret;
  284. }
  285. static int ethtool_get_coalesce(struct net_device *dev, void __user *useraddr)
  286. {
  287. struct ethtool_coalesce coalesce = { ETHTOOL_GCOALESCE };
  288. if (!dev->ethtool_ops->get_coalesce)
  289. return -EOPNOTSUPP;
  290. dev->ethtool_ops->get_coalesce(dev, &coalesce);
  291. if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
  292. return -EFAULT;
  293. return 0;
  294. }
  295. static int ethtool_set_coalesce(struct net_device *dev, void __user *useraddr)
  296. {
  297. struct ethtool_coalesce coalesce;
  298. if (!dev->ethtool_ops->set_coalesce)
  299. return -EOPNOTSUPP;
  300. if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
  301. return -EFAULT;
  302. return dev->ethtool_ops->set_coalesce(dev, &coalesce);
  303. }
  304. static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
  305. {
  306. struct ethtool_ringparam ringparam = { ETHTOOL_GRINGPARAM };
  307. if (!dev->ethtool_ops->get_ringparam)
  308. return -EOPNOTSUPP;
  309. dev->ethtool_ops->get_ringparam(dev, &ringparam);
  310. if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
  311. return -EFAULT;
  312. return 0;
  313. }
  314. static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
  315. {
  316. struct ethtool_ringparam ringparam;
  317. if (!dev->ethtool_ops->set_ringparam)
  318. return -EOPNOTSUPP;
  319. if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
  320. return -EFAULT;
  321. return dev->ethtool_ops->set_ringparam(dev, &ringparam);
  322. }
  323. static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
  324. {
  325. struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM };
  326. if (!dev->ethtool_ops->get_pauseparam)
  327. return -EOPNOTSUPP;
  328. dev->ethtool_ops->get_pauseparam(dev, &pauseparam);
  329. if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
  330. return -EFAULT;
  331. return 0;
  332. }
  333. static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
  334. {
  335. struct ethtool_pauseparam pauseparam;
  336. if (!dev->ethtool_ops->set_pauseparam)
  337. return -EOPNOTSUPP;
  338. if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
  339. return -EFAULT;
  340. return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
  341. }
  342. static int ethtool_get_rx_csum(struct net_device *dev, char __user *useraddr)
  343. {
  344. struct ethtool_value edata = { ETHTOOL_GRXCSUM };
  345. if (!dev->ethtool_ops->get_rx_csum)
  346. return -EOPNOTSUPP;
  347. edata.data = dev->ethtool_ops->get_rx_csum(dev);
  348. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  349. return -EFAULT;
  350. return 0;
  351. }
  352. static int ethtool_set_rx_csum(struct net_device *dev, char __user *useraddr)
  353. {
  354. struct ethtool_value edata;
  355. if (!dev->ethtool_ops->set_rx_csum)
  356. return -EOPNOTSUPP;
  357. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  358. return -EFAULT;
  359. dev->ethtool_ops->set_rx_csum(dev, edata.data);
  360. return 0;
  361. }
  362. static int ethtool_get_tx_csum(struct net_device *dev, char __user *useraddr)
  363. {
  364. struct ethtool_value edata = { ETHTOOL_GTXCSUM };
  365. if (!dev->ethtool_ops->get_tx_csum)
  366. return -EOPNOTSUPP;
  367. edata.data = dev->ethtool_ops->get_tx_csum(dev);
  368. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  369. return -EFAULT;
  370. return 0;
  371. }
  372. static int __ethtool_set_sg(struct net_device *dev, u32 data)
  373. {
  374. int err;
  375. if (!data && dev->ethtool_ops->set_tso) {
  376. err = dev->ethtool_ops->set_tso(dev, 0);
  377. if (err)
  378. return err;
  379. }
  380. if (!data && dev->ethtool_ops->set_ufo) {
  381. err = dev->ethtool_ops->set_ufo(dev, 0);
  382. if (err)
  383. return err;
  384. }
  385. return dev->ethtool_ops->set_sg(dev, data);
  386. }
  387. static int ethtool_set_tx_csum(struct net_device *dev, char __user *useraddr)
  388. {
  389. struct ethtool_value edata;
  390. int err;
  391. if (!dev->ethtool_ops->set_tx_csum)
  392. return -EOPNOTSUPP;
  393. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  394. return -EFAULT;
  395. if (!edata.data && dev->ethtool_ops->set_sg) {
  396. err = __ethtool_set_sg(dev, 0);
  397. if (err)
  398. return err;
  399. }
  400. return dev->ethtool_ops->set_tx_csum(dev, edata.data);
  401. }
  402. static int ethtool_get_sg(struct net_device *dev, char __user *useraddr)
  403. {
  404. struct ethtool_value edata = { ETHTOOL_GSG };
  405. if (!dev->ethtool_ops->get_sg)
  406. return -EOPNOTSUPP;
  407. edata.data = dev->ethtool_ops->get_sg(dev);
  408. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  409. return -EFAULT;
  410. return 0;
  411. }
  412. static int ethtool_set_sg(struct net_device *dev, char __user *useraddr)
  413. {
  414. struct ethtool_value edata;
  415. if (!dev->ethtool_ops->set_sg)
  416. return -EOPNOTSUPP;
  417. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  418. return -EFAULT;
  419. if (edata.data &&
  420. !(dev->features & NETIF_F_ALL_CSUM))
  421. return -EINVAL;
  422. return __ethtool_set_sg(dev, edata.data);
  423. }
  424. static int ethtool_get_tso(struct net_device *dev, char __user *useraddr)
  425. {
  426. struct ethtool_value edata = { ETHTOOL_GTSO };
  427. if (!dev->ethtool_ops->get_tso)
  428. return -EOPNOTSUPP;
  429. edata.data = dev->ethtool_ops->get_tso(dev);
  430. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  431. return -EFAULT;
  432. return 0;
  433. }
  434. static int ethtool_set_tso(struct net_device *dev, char __user *useraddr)
  435. {
  436. struct ethtool_value edata;
  437. if (!dev->ethtool_ops->set_tso)
  438. return -EOPNOTSUPP;
  439. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  440. return -EFAULT;
  441. if (edata.data && !(dev->features & NETIF_F_SG))
  442. return -EINVAL;
  443. return dev->ethtool_ops->set_tso(dev, edata.data);
  444. }
  445. static int ethtool_get_ufo(struct net_device *dev, char __user *useraddr)
  446. {
  447. struct ethtool_value edata = { ETHTOOL_GUFO };
  448. if (!dev->ethtool_ops->get_ufo)
  449. return -EOPNOTSUPP;
  450. edata.data = dev->ethtool_ops->get_ufo(dev);
  451. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  452. return -EFAULT;
  453. return 0;
  454. }
  455. static int ethtool_set_ufo(struct net_device *dev, char __user *useraddr)
  456. {
  457. struct ethtool_value edata;
  458. if (!dev->ethtool_ops->set_ufo)
  459. return -EOPNOTSUPP;
  460. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  461. return -EFAULT;
  462. if (edata.data && !(dev->features & NETIF_F_SG))
  463. return -EINVAL;
  464. if (edata.data && !(dev->features & NETIF_F_HW_CSUM))
  465. return -EINVAL;
  466. return dev->ethtool_ops->set_ufo(dev, edata.data);
  467. }
  468. static int ethtool_get_gso(struct net_device *dev, char __user *useraddr)
  469. {
  470. struct ethtool_value edata = { ETHTOOL_GGSO };
  471. edata.data = dev->features & NETIF_F_GSO;
  472. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  473. return -EFAULT;
  474. return 0;
  475. }
  476. static int ethtool_set_gso(struct net_device *dev, char __user *useraddr)
  477. {
  478. struct ethtool_value edata;
  479. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  480. return -EFAULT;
  481. if (edata.data)
  482. dev->features |= NETIF_F_GSO;
  483. else
  484. dev->features &= ~NETIF_F_GSO;
  485. return 0;
  486. }
  487. static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
  488. {
  489. struct ethtool_test test;
  490. const struct ethtool_ops *ops = dev->ethtool_ops;
  491. u64 *data;
  492. int ret;
  493. if (!ops->self_test || !ops->self_test_count)
  494. return -EOPNOTSUPP;
  495. if (copy_from_user(&test, useraddr, sizeof(test)))
  496. return -EFAULT;
  497. test.len = ops->self_test_count(dev);
  498. data = kmalloc(test.len * sizeof(u64), GFP_USER);
  499. if (!data)
  500. return -ENOMEM;
  501. ops->self_test(dev, &test, data);
  502. ret = -EFAULT;
  503. if (copy_to_user(useraddr, &test, sizeof(test)))
  504. goto out;
  505. useraddr += sizeof(test);
  506. if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
  507. goto out;
  508. ret = 0;
  509. out:
  510. kfree(data);
  511. return ret;
  512. }
  513. static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
  514. {
  515. struct ethtool_gstrings gstrings;
  516. const struct ethtool_ops *ops = dev->ethtool_ops;
  517. u8 *data;
  518. int ret;
  519. if (!ops->get_strings)
  520. return -EOPNOTSUPP;
  521. if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
  522. return -EFAULT;
  523. switch (gstrings.string_set) {
  524. case ETH_SS_TEST:
  525. if (!ops->self_test_count)
  526. return -EOPNOTSUPP;
  527. gstrings.len = ops->self_test_count(dev);
  528. break;
  529. case ETH_SS_STATS:
  530. if (!ops->get_stats_count)
  531. return -EOPNOTSUPP;
  532. gstrings.len = ops->get_stats_count(dev);
  533. break;
  534. default:
  535. return -EINVAL;
  536. }
  537. data = kmalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER);
  538. if (!data)
  539. return -ENOMEM;
  540. ops->get_strings(dev, gstrings.string_set, data);
  541. ret = -EFAULT;
  542. if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
  543. goto out;
  544. useraddr += sizeof(gstrings);
  545. if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
  546. goto out;
  547. ret = 0;
  548. out:
  549. kfree(data);
  550. return ret;
  551. }
  552. static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
  553. {
  554. struct ethtool_value id;
  555. if (!dev->ethtool_ops->phys_id)
  556. return -EOPNOTSUPP;
  557. if (copy_from_user(&id, useraddr, sizeof(id)))
  558. return -EFAULT;
  559. return dev->ethtool_ops->phys_id(dev, id.data);
  560. }
  561. static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
  562. {
  563. struct ethtool_stats stats;
  564. const struct ethtool_ops *ops = dev->ethtool_ops;
  565. u64 *data;
  566. int ret;
  567. if (!ops->get_ethtool_stats || !ops->get_stats_count)
  568. return -EOPNOTSUPP;
  569. if (copy_from_user(&stats, useraddr, sizeof(stats)))
  570. return -EFAULT;
  571. stats.n_stats = ops->get_stats_count(dev);
  572. data = kmalloc(stats.n_stats * sizeof(u64), GFP_USER);
  573. if (!data)
  574. return -ENOMEM;
  575. ops->get_ethtool_stats(dev, &stats, data);
  576. ret = -EFAULT;
  577. if (copy_to_user(useraddr, &stats, sizeof(stats)))
  578. goto out;
  579. useraddr += sizeof(stats);
  580. if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
  581. goto out;
  582. ret = 0;
  583. out:
  584. kfree(data);
  585. return ret;
  586. }
  587. static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
  588. {
  589. struct ethtool_perm_addr epaddr;
  590. u8 *data;
  591. int ret;
  592. if (!dev->ethtool_ops->get_perm_addr)
  593. return -EOPNOTSUPP;
  594. if (copy_from_user(&epaddr,useraddr,sizeof(epaddr)))
  595. return -EFAULT;
  596. data = kmalloc(epaddr.size, GFP_USER);
  597. if (!data)
  598. return -ENOMEM;
  599. ret = dev->ethtool_ops->get_perm_addr(dev,&epaddr,data);
  600. if (ret)
  601. return ret;
  602. ret = -EFAULT;
  603. if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
  604. goto out;
  605. useraddr += sizeof(epaddr);
  606. if (copy_to_user(useraddr, data, epaddr.size))
  607. goto out;
  608. ret = 0;
  609. out:
  610. kfree(data);
  611. return ret;
  612. }
  613. /* The main entry point in this file. Called from net/core/dev.c */
  614. int dev_ethtool(struct ifreq *ifr)
  615. {
  616. struct net_device *dev = __dev_get_by_name(ifr->ifr_name);
  617. void __user *useraddr = ifr->ifr_data;
  618. u32 ethcmd;
  619. int rc;
  620. unsigned long old_features;
  621. /*
  622. * XXX: This can be pushed down into the ethtool_* handlers that
  623. * need it. Keep existing behaviour for the moment.
  624. */
  625. if (!capable(CAP_NET_ADMIN))
  626. return -EPERM;
  627. if (!dev || !netif_device_present(dev))
  628. return -ENODEV;
  629. if (!dev->ethtool_ops)
  630. goto ioctl;
  631. if (copy_from_user(&ethcmd, useraddr, sizeof (ethcmd)))
  632. return -EFAULT;
  633. if(dev->ethtool_ops->begin)
  634. if ((rc = dev->ethtool_ops->begin(dev)) < 0)
  635. return rc;
  636. old_features = dev->features;
  637. switch (ethcmd) {
  638. case ETHTOOL_GSET:
  639. rc = ethtool_get_settings(dev, useraddr);
  640. break;
  641. case ETHTOOL_SSET:
  642. rc = ethtool_set_settings(dev, useraddr);
  643. break;
  644. case ETHTOOL_GDRVINFO:
  645. rc = ethtool_get_drvinfo(dev, useraddr);
  646. break;
  647. case ETHTOOL_GREGS:
  648. rc = ethtool_get_regs(dev, useraddr);
  649. break;
  650. case ETHTOOL_GWOL:
  651. rc = ethtool_get_wol(dev, useraddr);
  652. break;
  653. case ETHTOOL_SWOL:
  654. rc = ethtool_set_wol(dev, useraddr);
  655. break;
  656. case ETHTOOL_GMSGLVL:
  657. rc = ethtool_get_msglevel(dev, useraddr);
  658. break;
  659. case ETHTOOL_SMSGLVL:
  660. rc = ethtool_set_msglevel(dev, useraddr);
  661. break;
  662. case ETHTOOL_NWAY_RST:
  663. rc = ethtool_nway_reset(dev);
  664. break;
  665. case ETHTOOL_GLINK:
  666. rc = ethtool_get_link(dev, useraddr);
  667. break;
  668. case ETHTOOL_GEEPROM:
  669. rc = ethtool_get_eeprom(dev, useraddr);
  670. break;
  671. case ETHTOOL_SEEPROM:
  672. rc = ethtool_set_eeprom(dev, useraddr);
  673. break;
  674. case ETHTOOL_GCOALESCE:
  675. rc = ethtool_get_coalesce(dev, useraddr);
  676. break;
  677. case ETHTOOL_SCOALESCE:
  678. rc = ethtool_set_coalesce(dev, useraddr);
  679. break;
  680. case ETHTOOL_GRINGPARAM:
  681. rc = ethtool_get_ringparam(dev, useraddr);
  682. break;
  683. case ETHTOOL_SRINGPARAM:
  684. rc = ethtool_set_ringparam(dev, useraddr);
  685. break;
  686. case ETHTOOL_GPAUSEPARAM:
  687. rc = ethtool_get_pauseparam(dev, useraddr);
  688. break;
  689. case ETHTOOL_SPAUSEPARAM:
  690. rc = ethtool_set_pauseparam(dev, useraddr);
  691. break;
  692. case ETHTOOL_GRXCSUM:
  693. rc = ethtool_get_rx_csum(dev, useraddr);
  694. break;
  695. case ETHTOOL_SRXCSUM:
  696. rc = ethtool_set_rx_csum(dev, useraddr);
  697. break;
  698. case ETHTOOL_GTXCSUM:
  699. rc = ethtool_get_tx_csum(dev, useraddr);
  700. break;
  701. case ETHTOOL_STXCSUM:
  702. rc = ethtool_set_tx_csum(dev, useraddr);
  703. break;
  704. case ETHTOOL_GSG:
  705. rc = ethtool_get_sg(dev, useraddr);
  706. break;
  707. case ETHTOOL_SSG:
  708. rc = ethtool_set_sg(dev, useraddr);
  709. break;
  710. case ETHTOOL_GTSO:
  711. rc = ethtool_get_tso(dev, useraddr);
  712. break;
  713. case ETHTOOL_STSO:
  714. rc = ethtool_set_tso(dev, useraddr);
  715. break;
  716. case ETHTOOL_TEST:
  717. rc = ethtool_self_test(dev, useraddr);
  718. break;
  719. case ETHTOOL_GSTRINGS:
  720. rc = ethtool_get_strings(dev, useraddr);
  721. break;
  722. case ETHTOOL_PHYS_ID:
  723. rc = ethtool_phys_id(dev, useraddr);
  724. break;
  725. case ETHTOOL_GSTATS:
  726. rc = ethtool_get_stats(dev, useraddr);
  727. break;
  728. case ETHTOOL_GPERMADDR:
  729. rc = ethtool_get_perm_addr(dev, useraddr);
  730. break;
  731. case ETHTOOL_GUFO:
  732. rc = ethtool_get_ufo(dev, useraddr);
  733. break;
  734. case ETHTOOL_SUFO:
  735. rc = ethtool_set_ufo(dev, useraddr);
  736. break;
  737. case ETHTOOL_GGSO:
  738. rc = ethtool_get_gso(dev, useraddr);
  739. break;
  740. case ETHTOOL_SGSO:
  741. rc = ethtool_set_gso(dev, useraddr);
  742. break;
  743. default:
  744. rc = -EOPNOTSUPP;
  745. }
  746. if(dev->ethtool_ops->complete)
  747. dev->ethtool_ops->complete(dev);
  748. if (old_features != dev->features)
  749. netdev_features_change(dev);
  750. return rc;
  751. ioctl:
  752. if (dev->do_ioctl)
  753. return dev->do_ioctl(dev, ifr, SIOCETHTOOL);
  754. return -EOPNOTSUPP;
  755. }
  756. EXPORT_SYMBOL(dev_ethtool);
  757. EXPORT_SYMBOL(ethtool_op_get_link);
  758. EXPORT_SYMBOL_GPL(ethtool_op_get_perm_addr);
  759. EXPORT_SYMBOL(ethtool_op_get_sg);
  760. EXPORT_SYMBOL(ethtool_op_get_tso);
  761. EXPORT_SYMBOL(ethtool_op_get_tx_csum);
  762. EXPORT_SYMBOL(ethtool_op_set_sg);
  763. EXPORT_SYMBOL(ethtool_op_set_tso);
  764. EXPORT_SYMBOL(ethtool_op_set_tx_csum);
  765. EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
  766. EXPORT_SYMBOL(ethtool_op_set_ufo);
  767. EXPORT_SYMBOL(ethtool_op_get_ufo);