ethtool.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938
  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_IP_CSUM | NETIF_F_HW_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. 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. 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. 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. 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->get_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_IP_CSUM |
  421. NETIF_F_NO_CSUM |
  422. NETIF_F_HW_CSUM)))
  423. return -EINVAL;
  424. return __ethtool_set_sg(dev, edata.data);
  425. }
  426. static int ethtool_get_tso(struct net_device *dev, char __user *useraddr)
  427. {
  428. struct ethtool_value edata = { ETHTOOL_GTSO };
  429. if (!dev->ethtool_ops->get_tso)
  430. return -EOPNOTSUPP;
  431. edata.data = dev->ethtool_ops->get_tso(dev);
  432. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  433. return -EFAULT;
  434. return 0;
  435. }
  436. static int ethtool_set_tso(struct net_device *dev, char __user *useraddr)
  437. {
  438. struct ethtool_value edata;
  439. if (!dev->ethtool_ops->set_tso)
  440. return -EOPNOTSUPP;
  441. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  442. return -EFAULT;
  443. if (edata.data && !(dev->features & NETIF_F_SG))
  444. return -EINVAL;
  445. return dev->ethtool_ops->set_tso(dev, edata.data);
  446. }
  447. static int ethtool_get_ufo(struct net_device *dev, char __user *useraddr)
  448. {
  449. struct ethtool_value edata = { ETHTOOL_GTSO };
  450. if (!dev->ethtool_ops->get_ufo)
  451. return -EOPNOTSUPP;
  452. edata.data = dev->ethtool_ops->get_ufo(dev);
  453. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  454. return -EFAULT;
  455. return 0;
  456. }
  457. static int ethtool_set_ufo(struct net_device *dev, char __user *useraddr)
  458. {
  459. struct ethtool_value edata;
  460. if (!dev->ethtool_ops->set_ufo)
  461. return -EOPNOTSUPP;
  462. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  463. return -EFAULT;
  464. if (edata.data && !(dev->features & NETIF_F_SG))
  465. return -EINVAL;
  466. if (edata.data && !(dev->features & NETIF_F_HW_CSUM))
  467. return -EINVAL;
  468. return dev->ethtool_ops->set_ufo(dev, edata.data);
  469. }
  470. static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
  471. {
  472. struct ethtool_test test;
  473. struct ethtool_ops *ops = dev->ethtool_ops;
  474. u64 *data;
  475. int ret;
  476. if (!ops->self_test || !ops->self_test_count)
  477. return -EOPNOTSUPP;
  478. if (copy_from_user(&test, useraddr, sizeof(test)))
  479. return -EFAULT;
  480. test.len = ops->self_test_count(dev);
  481. data = kmalloc(test.len * sizeof(u64), GFP_USER);
  482. if (!data)
  483. return -ENOMEM;
  484. ops->self_test(dev, &test, data);
  485. ret = -EFAULT;
  486. if (copy_to_user(useraddr, &test, sizeof(test)))
  487. goto out;
  488. useraddr += sizeof(test);
  489. if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
  490. goto out;
  491. ret = 0;
  492. out:
  493. kfree(data);
  494. return ret;
  495. }
  496. static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
  497. {
  498. struct ethtool_gstrings gstrings;
  499. struct ethtool_ops *ops = dev->ethtool_ops;
  500. u8 *data;
  501. int ret;
  502. if (!ops->get_strings)
  503. return -EOPNOTSUPP;
  504. if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
  505. return -EFAULT;
  506. switch (gstrings.string_set) {
  507. case ETH_SS_TEST:
  508. if (!ops->self_test_count)
  509. return -EOPNOTSUPP;
  510. gstrings.len = ops->self_test_count(dev);
  511. break;
  512. case ETH_SS_STATS:
  513. if (!ops->get_stats_count)
  514. return -EOPNOTSUPP;
  515. gstrings.len = ops->get_stats_count(dev);
  516. break;
  517. default:
  518. return -EINVAL;
  519. }
  520. data = kmalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER);
  521. if (!data)
  522. return -ENOMEM;
  523. ops->get_strings(dev, gstrings.string_set, data);
  524. ret = -EFAULT;
  525. if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
  526. goto out;
  527. useraddr += sizeof(gstrings);
  528. if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
  529. goto out;
  530. ret = 0;
  531. out:
  532. kfree(data);
  533. return ret;
  534. }
  535. static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
  536. {
  537. struct ethtool_value id;
  538. if (!dev->ethtool_ops->phys_id)
  539. return -EOPNOTSUPP;
  540. if (copy_from_user(&id, useraddr, sizeof(id)))
  541. return -EFAULT;
  542. return dev->ethtool_ops->phys_id(dev, id.data);
  543. }
  544. static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
  545. {
  546. struct ethtool_stats stats;
  547. struct ethtool_ops *ops = dev->ethtool_ops;
  548. u64 *data;
  549. int ret;
  550. if (!ops->get_ethtool_stats || !ops->get_stats_count)
  551. return -EOPNOTSUPP;
  552. if (copy_from_user(&stats, useraddr, sizeof(stats)))
  553. return -EFAULT;
  554. stats.n_stats = ops->get_stats_count(dev);
  555. data = kmalloc(stats.n_stats * sizeof(u64), GFP_USER);
  556. if (!data)
  557. return -ENOMEM;
  558. ops->get_ethtool_stats(dev, &stats, data);
  559. ret = -EFAULT;
  560. if (copy_to_user(useraddr, &stats, sizeof(stats)))
  561. goto out;
  562. useraddr += sizeof(stats);
  563. if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
  564. goto out;
  565. ret = 0;
  566. out:
  567. kfree(data);
  568. return ret;
  569. }
  570. static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
  571. {
  572. struct ethtool_perm_addr epaddr;
  573. u8 *data;
  574. int ret;
  575. if (!dev->ethtool_ops->get_perm_addr)
  576. return -EOPNOTSUPP;
  577. if (copy_from_user(&epaddr,useraddr,sizeof(epaddr)))
  578. return -EFAULT;
  579. data = kmalloc(epaddr.size, GFP_USER);
  580. if (!data)
  581. return -ENOMEM;
  582. ret = dev->ethtool_ops->get_perm_addr(dev,&epaddr,data);
  583. if (ret)
  584. return ret;
  585. ret = -EFAULT;
  586. if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
  587. goto out;
  588. useraddr += sizeof(epaddr);
  589. if (copy_to_user(useraddr, data, epaddr.size))
  590. goto out;
  591. ret = 0;
  592. out:
  593. kfree(data);
  594. return ret;
  595. }
  596. /* The main entry point in this file. Called from net/core/dev.c */
  597. int dev_ethtool(struct ifreq *ifr)
  598. {
  599. struct net_device *dev = __dev_get_by_name(ifr->ifr_name);
  600. void __user *useraddr = ifr->ifr_data;
  601. u32 ethcmd;
  602. int rc;
  603. unsigned long old_features;
  604. /*
  605. * XXX: This can be pushed down into the ethtool_* handlers that
  606. * need it. Keep existing behaviour for the moment.
  607. */
  608. if (!capable(CAP_NET_ADMIN))
  609. return -EPERM;
  610. if (!dev || !netif_device_present(dev))
  611. return -ENODEV;
  612. if (!dev->ethtool_ops)
  613. goto ioctl;
  614. if (copy_from_user(&ethcmd, useraddr, sizeof (ethcmd)))
  615. return -EFAULT;
  616. if(dev->ethtool_ops->begin)
  617. if ((rc = dev->ethtool_ops->begin(dev)) < 0)
  618. return rc;
  619. old_features = dev->features;
  620. switch (ethcmd) {
  621. case ETHTOOL_GSET:
  622. rc = ethtool_get_settings(dev, useraddr);
  623. break;
  624. case ETHTOOL_SSET:
  625. rc = ethtool_set_settings(dev, useraddr);
  626. break;
  627. case ETHTOOL_GDRVINFO:
  628. rc = ethtool_get_drvinfo(dev, useraddr);
  629. break;
  630. case ETHTOOL_GREGS:
  631. rc = ethtool_get_regs(dev, useraddr);
  632. break;
  633. case ETHTOOL_GWOL:
  634. rc = ethtool_get_wol(dev, useraddr);
  635. break;
  636. case ETHTOOL_SWOL:
  637. rc = ethtool_set_wol(dev, useraddr);
  638. break;
  639. case ETHTOOL_GMSGLVL:
  640. rc = ethtool_get_msglevel(dev, useraddr);
  641. break;
  642. case ETHTOOL_SMSGLVL:
  643. rc = ethtool_set_msglevel(dev, useraddr);
  644. break;
  645. case ETHTOOL_NWAY_RST:
  646. rc = ethtool_nway_reset(dev);
  647. break;
  648. case ETHTOOL_GLINK:
  649. rc = ethtool_get_link(dev, useraddr);
  650. break;
  651. case ETHTOOL_GEEPROM:
  652. rc = ethtool_get_eeprom(dev, useraddr);
  653. break;
  654. case ETHTOOL_SEEPROM:
  655. rc = ethtool_set_eeprom(dev, useraddr);
  656. break;
  657. case ETHTOOL_GCOALESCE:
  658. rc = ethtool_get_coalesce(dev, useraddr);
  659. break;
  660. case ETHTOOL_SCOALESCE:
  661. rc = ethtool_set_coalesce(dev, useraddr);
  662. break;
  663. case ETHTOOL_GRINGPARAM:
  664. rc = ethtool_get_ringparam(dev, useraddr);
  665. break;
  666. case ETHTOOL_SRINGPARAM:
  667. rc = ethtool_set_ringparam(dev, useraddr);
  668. break;
  669. case ETHTOOL_GPAUSEPARAM:
  670. rc = ethtool_get_pauseparam(dev, useraddr);
  671. break;
  672. case ETHTOOL_SPAUSEPARAM:
  673. rc = ethtool_set_pauseparam(dev, useraddr);
  674. break;
  675. case ETHTOOL_GRXCSUM:
  676. rc = ethtool_get_rx_csum(dev, useraddr);
  677. break;
  678. case ETHTOOL_SRXCSUM:
  679. rc = ethtool_set_rx_csum(dev, useraddr);
  680. break;
  681. case ETHTOOL_GTXCSUM:
  682. rc = ethtool_get_tx_csum(dev, useraddr);
  683. break;
  684. case ETHTOOL_STXCSUM:
  685. rc = ethtool_set_tx_csum(dev, useraddr);
  686. break;
  687. case ETHTOOL_GSG:
  688. rc = ethtool_get_sg(dev, useraddr);
  689. break;
  690. case ETHTOOL_SSG:
  691. rc = ethtool_set_sg(dev, useraddr);
  692. break;
  693. case ETHTOOL_GTSO:
  694. rc = ethtool_get_tso(dev, useraddr);
  695. break;
  696. case ETHTOOL_STSO:
  697. rc = ethtool_set_tso(dev, useraddr);
  698. break;
  699. case ETHTOOL_TEST:
  700. rc = ethtool_self_test(dev, useraddr);
  701. break;
  702. case ETHTOOL_GSTRINGS:
  703. rc = ethtool_get_strings(dev, useraddr);
  704. break;
  705. case ETHTOOL_PHYS_ID:
  706. rc = ethtool_phys_id(dev, useraddr);
  707. break;
  708. case ETHTOOL_GSTATS:
  709. rc = ethtool_get_stats(dev, useraddr);
  710. break;
  711. case ETHTOOL_GPERMADDR:
  712. rc = ethtool_get_perm_addr(dev, useraddr);
  713. break;
  714. case ETHTOOL_GUFO:
  715. rc = ethtool_get_ufo(dev, useraddr);
  716. break;
  717. case ETHTOOL_SUFO:
  718. rc = ethtool_set_ufo(dev, useraddr);
  719. break;
  720. default:
  721. rc = -EOPNOTSUPP;
  722. }
  723. if(dev->ethtool_ops->complete)
  724. dev->ethtool_ops->complete(dev);
  725. if (old_features != dev->features)
  726. netdev_features_change(dev);
  727. return rc;
  728. ioctl:
  729. if (dev->do_ioctl)
  730. return dev->do_ioctl(dev, ifr, SIOCETHTOOL);
  731. return -EOPNOTSUPP;
  732. }
  733. EXPORT_SYMBOL(dev_ethtool);
  734. EXPORT_SYMBOL(ethtool_op_get_link);
  735. EXPORT_SYMBOL_GPL(ethtool_op_get_perm_addr);
  736. EXPORT_SYMBOL(ethtool_op_get_sg);
  737. EXPORT_SYMBOL(ethtool_op_get_tso);
  738. EXPORT_SYMBOL(ethtool_op_get_tx_csum);
  739. EXPORT_SYMBOL(ethtool_op_set_sg);
  740. EXPORT_SYMBOL(ethtool_op_set_tso);
  741. EXPORT_SYMBOL(ethtool_op_set_tx_csum);
  742. EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
  743. EXPORT_SYMBOL(ethtool_op_set_ufo);
  744. EXPORT_SYMBOL(ethtool_op_get_ufo);