ibmveth.c 40 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360
  1. /**************************************************************************/
  2. /* */
  3. /* IBM eServer i/pSeries Virtual Ethernet Device Driver */
  4. /* Copyright (C) 2003 IBM Corp. */
  5. /* Originally written by Dave Larson (larson1@us.ibm.com) */
  6. /* Maintained by Santiago Leon (santil@us.ibm.com) */
  7. /* */
  8. /* This program is free software; you can redistribute it and/or modify */
  9. /* it under the terms of the GNU General Public License as published by */
  10. /* the Free Software Foundation; either version 2 of the License, or */
  11. /* (at your option) any later version. */
  12. /* */
  13. /* This program is distributed in the hope that it will be useful, */
  14. /* but WITHOUT ANY WARRANTY; without even the implied warranty of */
  15. /* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the */
  16. /* GNU General Public License for more details. */
  17. /* */
  18. /* You should have received a copy of the GNU General Public License */
  19. /* along with this program; if not, write to the Free Software */
  20. /* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 */
  21. /* USA */
  22. /* */
  23. /* This module contains the implementation of a virtual ethernet device */
  24. /* for use with IBM i/pSeries LPAR Linux. It utilizes the logical LAN */
  25. /* option of the RS/6000 Platform Architechture to interface with virtual */
  26. /* ethernet NICs that are presented to the partition by the hypervisor. */
  27. /* */
  28. /**************************************************************************/
  29. /*
  30. TODO:
  31. - remove frag processing code - no longer needed
  32. - add support for sysfs
  33. - possibly remove procfs support
  34. */
  35. #include <linux/module.h>
  36. #include <linux/types.h>
  37. #include <linux/errno.h>
  38. #include <linux/ioport.h>
  39. #include <linux/dma-mapping.h>
  40. #include <linux/kernel.h>
  41. #include <linux/netdevice.h>
  42. #include <linux/etherdevice.h>
  43. #include <linux/skbuff.h>
  44. #include <linux/init.h>
  45. #include <linux/delay.h>
  46. #include <linux/mm.h>
  47. #include <linux/ethtool.h>
  48. #include <linux/proc_fs.h>
  49. #include <asm/semaphore.h>
  50. #include <asm/hvcall.h>
  51. #include <asm/atomic.h>
  52. #include <asm/iommu.h>
  53. #include <asm/vio.h>
  54. #include <asm/uaccess.h>
  55. #include <linux/seq_file.h>
  56. #include "ibmveth.h"
  57. #undef DEBUG
  58. #define ibmveth_printk(fmt, args...) \
  59. printk(KERN_DEBUG "%s: " fmt, __FILE__, ## args)
  60. #define ibmveth_error_printk(fmt, args...) \
  61. printk(KERN_ERR "(%s:%3.3d ua:%x) ERROR: " fmt, __FILE__, __LINE__ , adapter->vdev->unit_address, ## args)
  62. #ifdef DEBUG
  63. #define ibmveth_debug_printk_no_adapter(fmt, args...) \
  64. printk(KERN_DEBUG "(%s:%3.3d): " fmt, __FILE__, __LINE__ , ## args)
  65. #define ibmveth_debug_printk(fmt, args...) \
  66. printk(KERN_DEBUG "(%s:%3.3d ua:%x): " fmt, __FILE__, __LINE__ , adapter->vdev->unit_address, ## args)
  67. #define ibmveth_assert(expr) \
  68. if(!(expr)) { \
  69. printk(KERN_DEBUG "assertion failed (%s:%3.3d ua:%x): %s\n", __FILE__, __LINE__, adapter->vdev->unit_address, #expr); \
  70. BUG(); \
  71. }
  72. #else
  73. #define ibmveth_debug_printk_no_adapter(fmt, args...)
  74. #define ibmveth_debug_printk(fmt, args...)
  75. #define ibmveth_assert(expr)
  76. #endif
  77. static int ibmveth_open(struct net_device *dev);
  78. static int ibmveth_close(struct net_device *dev);
  79. static int ibmveth_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
  80. static int ibmveth_poll(struct net_device *dev, int *budget);
  81. static int ibmveth_start_xmit(struct sk_buff *skb, struct net_device *dev);
  82. static struct net_device_stats *ibmveth_get_stats(struct net_device *dev);
  83. static void ibmveth_set_multicast_list(struct net_device *dev);
  84. static int ibmveth_change_mtu(struct net_device *dev, int new_mtu);
  85. static void ibmveth_proc_register_driver(void);
  86. static void ibmveth_proc_unregister_driver(void);
  87. static void ibmveth_proc_register_adapter(struct ibmveth_adapter *adapter);
  88. static void ibmveth_proc_unregister_adapter(struct ibmveth_adapter *adapter);
  89. static irqreturn_t ibmveth_interrupt(int irq, void *dev_instance, struct pt_regs *regs);
  90. static inline void ibmveth_rxq_harvest_buffer(struct ibmveth_adapter *adapter);
  91. static struct kobj_type ktype_veth_pool;
  92. #ifdef CONFIG_PROC_FS
  93. #define IBMVETH_PROC_DIR "net/ibmveth"
  94. static struct proc_dir_entry *ibmveth_proc_dir;
  95. #endif
  96. static const char ibmveth_driver_name[] = "ibmveth";
  97. static const char ibmveth_driver_string[] = "IBM i/pSeries Virtual Ethernet Driver";
  98. #define ibmveth_driver_version "1.03"
  99. MODULE_AUTHOR("Santiago Leon <santil@us.ibm.com>");
  100. MODULE_DESCRIPTION("IBM i/pSeries Virtual Ethernet Driver");
  101. MODULE_LICENSE("GPL");
  102. MODULE_VERSION(ibmveth_driver_version);
  103. /* simple methods of getting data from the current rxq entry */
  104. static inline int ibmveth_rxq_pending_buffer(struct ibmveth_adapter *adapter)
  105. {
  106. return (adapter->rx_queue.queue_addr[adapter->rx_queue.index].toggle == adapter->rx_queue.toggle);
  107. }
  108. static inline int ibmveth_rxq_buffer_valid(struct ibmveth_adapter *adapter)
  109. {
  110. return (adapter->rx_queue.queue_addr[adapter->rx_queue.index].valid);
  111. }
  112. static inline int ibmveth_rxq_frame_offset(struct ibmveth_adapter *adapter)
  113. {
  114. return (adapter->rx_queue.queue_addr[adapter->rx_queue.index].offset);
  115. }
  116. static inline int ibmveth_rxq_frame_length(struct ibmveth_adapter *adapter)
  117. {
  118. return (adapter->rx_queue.queue_addr[adapter->rx_queue.index].length);
  119. }
  120. /* setup the initial settings for a buffer pool */
  121. static void ibmveth_init_buffer_pool(struct ibmveth_buff_pool *pool, u32 pool_index, u32 pool_size, u32 buff_size, u32 pool_active)
  122. {
  123. pool->size = pool_size;
  124. pool->index = pool_index;
  125. pool->buff_size = buff_size;
  126. pool->threshold = pool_size / 2;
  127. pool->active = pool_active;
  128. }
  129. /* allocate and setup an buffer pool - called during open */
  130. static int ibmveth_alloc_buffer_pool(struct ibmveth_buff_pool *pool)
  131. {
  132. int i;
  133. pool->free_map = kmalloc(sizeof(u16) * pool->size, GFP_KERNEL);
  134. if(!pool->free_map) {
  135. return -1;
  136. }
  137. pool->dma_addr = kmalloc(sizeof(dma_addr_t) * pool->size, GFP_KERNEL);
  138. if(!pool->dma_addr) {
  139. kfree(pool->free_map);
  140. pool->free_map = NULL;
  141. return -1;
  142. }
  143. pool->skbuff = kmalloc(sizeof(void*) * pool->size, GFP_KERNEL);
  144. if(!pool->skbuff) {
  145. kfree(pool->dma_addr);
  146. pool->dma_addr = NULL;
  147. kfree(pool->free_map);
  148. pool->free_map = NULL;
  149. return -1;
  150. }
  151. memset(pool->skbuff, 0, sizeof(void*) * pool->size);
  152. memset(pool->dma_addr, 0, sizeof(dma_addr_t) * pool->size);
  153. for(i = 0; i < pool->size; ++i) {
  154. pool->free_map[i] = i;
  155. }
  156. atomic_set(&pool->available, 0);
  157. pool->producer_index = 0;
  158. pool->consumer_index = 0;
  159. return 0;
  160. }
  161. /* replenish the buffers for a pool. note that we don't need to
  162. * skb_reserve these since they are used for incoming...
  163. */
  164. static void ibmveth_replenish_buffer_pool(struct ibmveth_adapter *adapter, struct ibmveth_buff_pool *pool)
  165. {
  166. u32 i;
  167. u32 count = pool->size - atomic_read(&pool->available);
  168. u32 buffers_added = 0;
  169. mb();
  170. for(i = 0; i < count; ++i) {
  171. struct sk_buff *skb;
  172. unsigned int free_index, index;
  173. u64 correlator;
  174. union ibmveth_buf_desc desc;
  175. unsigned long lpar_rc;
  176. dma_addr_t dma_addr;
  177. skb = alloc_skb(pool->buff_size, GFP_ATOMIC);
  178. if(!skb) {
  179. ibmveth_debug_printk("replenish: unable to allocate skb\n");
  180. adapter->replenish_no_mem++;
  181. break;
  182. }
  183. free_index = pool->consumer_index++ % pool->size;
  184. index = pool->free_map[free_index];
  185. ibmveth_assert(index != IBM_VETH_INVALID_MAP);
  186. ibmveth_assert(pool->skbuff[index] == NULL);
  187. dma_addr = dma_map_single(&adapter->vdev->dev, skb->data,
  188. pool->buff_size, DMA_FROM_DEVICE);
  189. pool->free_map[free_index] = IBM_VETH_INVALID_MAP;
  190. pool->dma_addr[index] = dma_addr;
  191. pool->skbuff[index] = skb;
  192. correlator = ((u64)pool->index << 32) | index;
  193. *(u64*)skb->data = correlator;
  194. desc.desc = 0;
  195. desc.fields.valid = 1;
  196. desc.fields.length = pool->buff_size;
  197. desc.fields.address = dma_addr;
  198. lpar_rc = h_add_logical_lan_buffer(adapter->vdev->unit_address, desc.desc);
  199. if(lpar_rc != H_SUCCESS) {
  200. pool->free_map[free_index] = index;
  201. pool->skbuff[index] = NULL;
  202. pool->consumer_index--;
  203. dma_unmap_single(&adapter->vdev->dev,
  204. pool->dma_addr[index], pool->buff_size,
  205. DMA_FROM_DEVICE);
  206. dev_kfree_skb_any(skb);
  207. adapter->replenish_add_buff_failure++;
  208. break;
  209. } else {
  210. buffers_added++;
  211. adapter->replenish_add_buff_success++;
  212. }
  213. }
  214. mb();
  215. atomic_add(buffers_added, &(pool->available));
  216. }
  217. /* replenish routine */
  218. static void ibmveth_replenish_task(struct ibmveth_adapter *adapter)
  219. {
  220. int i;
  221. adapter->replenish_task_cycles++;
  222. for(i = 0; i < IbmVethNumBufferPools; i++)
  223. if(adapter->rx_buff_pool[i].active)
  224. ibmveth_replenish_buffer_pool(adapter,
  225. &adapter->rx_buff_pool[i]);
  226. adapter->rx_no_buffer = *(u64*)(((char*)adapter->buffer_list_addr) + 4096 - 8);
  227. }
  228. /* empty and free ana buffer pool - also used to do cleanup in error paths */
  229. static void ibmveth_free_buffer_pool(struct ibmveth_adapter *adapter, struct ibmveth_buff_pool *pool)
  230. {
  231. int i;
  232. kfree(pool->free_map);
  233. pool->free_map = NULL;
  234. if(pool->skbuff && pool->dma_addr) {
  235. for(i = 0; i < pool->size; ++i) {
  236. struct sk_buff *skb = pool->skbuff[i];
  237. if(skb) {
  238. dma_unmap_single(&adapter->vdev->dev,
  239. pool->dma_addr[i],
  240. pool->buff_size,
  241. DMA_FROM_DEVICE);
  242. dev_kfree_skb_any(skb);
  243. pool->skbuff[i] = NULL;
  244. }
  245. }
  246. }
  247. if(pool->dma_addr) {
  248. kfree(pool->dma_addr);
  249. pool->dma_addr = NULL;
  250. }
  251. if(pool->skbuff) {
  252. kfree(pool->skbuff);
  253. pool->skbuff = NULL;
  254. }
  255. }
  256. /* remove a buffer from a pool */
  257. static void ibmveth_remove_buffer_from_pool(struct ibmveth_adapter *adapter, u64 correlator)
  258. {
  259. unsigned int pool = correlator >> 32;
  260. unsigned int index = correlator & 0xffffffffUL;
  261. unsigned int free_index;
  262. struct sk_buff *skb;
  263. ibmveth_assert(pool < IbmVethNumBufferPools);
  264. ibmveth_assert(index < adapter->rx_buff_pool[pool].size);
  265. skb = adapter->rx_buff_pool[pool].skbuff[index];
  266. ibmveth_assert(skb != NULL);
  267. adapter->rx_buff_pool[pool].skbuff[index] = NULL;
  268. dma_unmap_single(&adapter->vdev->dev,
  269. adapter->rx_buff_pool[pool].dma_addr[index],
  270. adapter->rx_buff_pool[pool].buff_size,
  271. DMA_FROM_DEVICE);
  272. free_index = adapter->rx_buff_pool[pool].producer_index++ % adapter->rx_buff_pool[pool].size;
  273. adapter->rx_buff_pool[pool].free_map[free_index] = index;
  274. mb();
  275. atomic_dec(&(adapter->rx_buff_pool[pool].available));
  276. }
  277. /* get the current buffer on the rx queue */
  278. static inline struct sk_buff *ibmveth_rxq_get_buffer(struct ibmveth_adapter *adapter)
  279. {
  280. u64 correlator = adapter->rx_queue.queue_addr[adapter->rx_queue.index].correlator;
  281. unsigned int pool = correlator >> 32;
  282. unsigned int index = correlator & 0xffffffffUL;
  283. ibmveth_assert(pool < IbmVethNumBufferPools);
  284. ibmveth_assert(index < adapter->rx_buff_pool[pool].size);
  285. return adapter->rx_buff_pool[pool].skbuff[index];
  286. }
  287. /* recycle the current buffer on the rx queue */
  288. static void ibmveth_rxq_recycle_buffer(struct ibmveth_adapter *adapter)
  289. {
  290. u32 q_index = adapter->rx_queue.index;
  291. u64 correlator = adapter->rx_queue.queue_addr[q_index].correlator;
  292. unsigned int pool = correlator >> 32;
  293. unsigned int index = correlator & 0xffffffffUL;
  294. union ibmveth_buf_desc desc;
  295. unsigned long lpar_rc;
  296. ibmveth_assert(pool < IbmVethNumBufferPools);
  297. ibmveth_assert(index < adapter->rx_buff_pool[pool].size);
  298. if(!adapter->rx_buff_pool[pool].active) {
  299. ibmveth_rxq_harvest_buffer(adapter);
  300. ibmveth_free_buffer_pool(adapter, &adapter->rx_buff_pool[pool]);
  301. return;
  302. }
  303. desc.desc = 0;
  304. desc.fields.valid = 1;
  305. desc.fields.length = adapter->rx_buff_pool[pool].buff_size;
  306. desc.fields.address = adapter->rx_buff_pool[pool].dma_addr[index];
  307. lpar_rc = h_add_logical_lan_buffer(adapter->vdev->unit_address, desc.desc);
  308. if(lpar_rc != H_SUCCESS) {
  309. ibmveth_debug_printk("h_add_logical_lan_buffer failed during recycle rc=%ld", lpar_rc);
  310. ibmveth_remove_buffer_from_pool(adapter, adapter->rx_queue.queue_addr[adapter->rx_queue.index].correlator);
  311. }
  312. if(++adapter->rx_queue.index == adapter->rx_queue.num_slots) {
  313. adapter->rx_queue.index = 0;
  314. adapter->rx_queue.toggle = !adapter->rx_queue.toggle;
  315. }
  316. }
  317. static inline void ibmveth_rxq_harvest_buffer(struct ibmveth_adapter *adapter)
  318. {
  319. ibmveth_remove_buffer_from_pool(adapter, adapter->rx_queue.queue_addr[adapter->rx_queue.index].correlator);
  320. if(++adapter->rx_queue.index == adapter->rx_queue.num_slots) {
  321. adapter->rx_queue.index = 0;
  322. adapter->rx_queue.toggle = !adapter->rx_queue.toggle;
  323. }
  324. }
  325. static void ibmveth_cleanup(struct ibmveth_adapter *adapter)
  326. {
  327. int i;
  328. if(adapter->buffer_list_addr != NULL) {
  329. if(!dma_mapping_error(adapter->buffer_list_dma)) {
  330. dma_unmap_single(&adapter->vdev->dev,
  331. adapter->buffer_list_dma, 4096,
  332. DMA_BIDIRECTIONAL);
  333. adapter->buffer_list_dma = DMA_ERROR_CODE;
  334. }
  335. free_page((unsigned long)adapter->buffer_list_addr);
  336. adapter->buffer_list_addr = NULL;
  337. }
  338. if(adapter->filter_list_addr != NULL) {
  339. if(!dma_mapping_error(adapter->filter_list_dma)) {
  340. dma_unmap_single(&adapter->vdev->dev,
  341. adapter->filter_list_dma, 4096,
  342. DMA_BIDIRECTIONAL);
  343. adapter->filter_list_dma = DMA_ERROR_CODE;
  344. }
  345. free_page((unsigned long)adapter->filter_list_addr);
  346. adapter->filter_list_addr = NULL;
  347. }
  348. if(adapter->rx_queue.queue_addr != NULL) {
  349. if(!dma_mapping_error(adapter->rx_queue.queue_dma)) {
  350. dma_unmap_single(&adapter->vdev->dev,
  351. adapter->rx_queue.queue_dma,
  352. adapter->rx_queue.queue_len,
  353. DMA_BIDIRECTIONAL);
  354. adapter->rx_queue.queue_dma = DMA_ERROR_CODE;
  355. }
  356. kfree(adapter->rx_queue.queue_addr);
  357. adapter->rx_queue.queue_addr = NULL;
  358. }
  359. for(i = 0; i<IbmVethNumBufferPools; i++)
  360. if (adapter->rx_buff_pool[i].active)
  361. ibmveth_free_buffer_pool(adapter,
  362. &adapter->rx_buff_pool[i]);
  363. }
  364. static int ibmveth_register_logical_lan(struct ibmveth_adapter *adapter,
  365. union ibmveth_buf_desc rxq_desc, u64 mac_address)
  366. {
  367. int rc, try_again = 1;
  368. /* After a kexec the adapter will still be open, so our attempt to
  369. * open it will fail. So if we get a failure we free the adapter and
  370. * try again, but only once. */
  371. retry:
  372. rc = h_register_logical_lan(adapter->vdev->unit_address,
  373. adapter->buffer_list_dma, rxq_desc.desc,
  374. adapter->filter_list_dma, mac_address);
  375. if (rc != H_SUCCESS && try_again) {
  376. do {
  377. rc = h_free_logical_lan(adapter->vdev->unit_address);
  378. } while (H_IS_LONG_BUSY(rc) || (rc == H_BUSY));
  379. try_again = 0;
  380. goto retry;
  381. }
  382. return rc;
  383. }
  384. static int ibmveth_open(struct net_device *netdev)
  385. {
  386. struct ibmveth_adapter *adapter = netdev->priv;
  387. u64 mac_address = 0;
  388. int rxq_entries = 1;
  389. unsigned long lpar_rc;
  390. int rc;
  391. union ibmveth_buf_desc rxq_desc;
  392. int i;
  393. ibmveth_debug_printk("open starting\n");
  394. for(i = 0; i<IbmVethNumBufferPools; i++)
  395. rxq_entries += adapter->rx_buff_pool[i].size;
  396. adapter->buffer_list_addr = (void*) get_zeroed_page(GFP_KERNEL);
  397. adapter->filter_list_addr = (void*) get_zeroed_page(GFP_KERNEL);
  398. if(!adapter->buffer_list_addr || !adapter->filter_list_addr) {
  399. ibmveth_error_printk("unable to allocate filter or buffer list pages\n");
  400. ibmveth_cleanup(adapter);
  401. return -ENOMEM;
  402. }
  403. adapter->rx_queue.queue_len = sizeof(struct ibmveth_rx_q_entry) * rxq_entries;
  404. adapter->rx_queue.queue_addr = kmalloc(adapter->rx_queue.queue_len, GFP_KERNEL);
  405. if(!adapter->rx_queue.queue_addr) {
  406. ibmveth_error_printk("unable to allocate rx queue pages\n");
  407. ibmveth_cleanup(adapter);
  408. return -ENOMEM;
  409. }
  410. adapter->buffer_list_dma = dma_map_single(&adapter->vdev->dev,
  411. adapter->buffer_list_addr, 4096, DMA_BIDIRECTIONAL);
  412. adapter->filter_list_dma = dma_map_single(&adapter->vdev->dev,
  413. adapter->filter_list_addr, 4096, DMA_BIDIRECTIONAL);
  414. adapter->rx_queue.queue_dma = dma_map_single(&adapter->vdev->dev,
  415. adapter->rx_queue.queue_addr,
  416. adapter->rx_queue.queue_len, DMA_BIDIRECTIONAL);
  417. if((dma_mapping_error(adapter->buffer_list_dma) ) ||
  418. (dma_mapping_error(adapter->filter_list_dma)) ||
  419. (dma_mapping_error(adapter->rx_queue.queue_dma))) {
  420. ibmveth_error_printk("unable to map filter or buffer list pages\n");
  421. ibmveth_cleanup(adapter);
  422. return -ENOMEM;
  423. }
  424. adapter->rx_queue.index = 0;
  425. adapter->rx_queue.num_slots = rxq_entries;
  426. adapter->rx_queue.toggle = 1;
  427. memcpy(&mac_address, netdev->dev_addr, netdev->addr_len);
  428. mac_address = mac_address >> 16;
  429. rxq_desc.desc = 0;
  430. rxq_desc.fields.valid = 1;
  431. rxq_desc.fields.length = adapter->rx_queue.queue_len;
  432. rxq_desc.fields.address = adapter->rx_queue.queue_dma;
  433. ibmveth_debug_printk("buffer list @ 0x%p\n", adapter->buffer_list_addr);
  434. ibmveth_debug_printk("filter list @ 0x%p\n", adapter->filter_list_addr);
  435. ibmveth_debug_printk("receive q @ 0x%p\n", adapter->rx_queue.queue_addr);
  436. lpar_rc = ibmveth_register_logical_lan(adapter, rxq_desc, mac_address);
  437. if(lpar_rc != H_SUCCESS) {
  438. ibmveth_error_printk("h_register_logical_lan failed with %ld\n", lpar_rc);
  439. ibmveth_error_printk("buffer TCE:0x%lx filter TCE:0x%lx rxq desc:0x%lx MAC:0x%lx\n",
  440. adapter->buffer_list_dma,
  441. adapter->filter_list_dma,
  442. rxq_desc.desc,
  443. mac_address);
  444. ibmveth_cleanup(adapter);
  445. return -ENONET;
  446. }
  447. for(i = 0; i<IbmVethNumBufferPools; i++) {
  448. if(!adapter->rx_buff_pool[i].active)
  449. continue;
  450. if (ibmveth_alloc_buffer_pool(&adapter->rx_buff_pool[i])) {
  451. ibmveth_error_printk("unable to alloc pool\n");
  452. adapter->rx_buff_pool[i].active = 0;
  453. ibmveth_cleanup(adapter);
  454. return -ENOMEM ;
  455. }
  456. }
  457. ibmveth_debug_printk("registering irq 0x%x\n", netdev->irq);
  458. if((rc = request_irq(netdev->irq, &ibmveth_interrupt, 0, netdev->name, netdev)) != 0) {
  459. ibmveth_error_printk("unable to request irq 0x%x, rc %d\n", netdev->irq, rc);
  460. do {
  461. rc = h_free_logical_lan(adapter->vdev->unit_address);
  462. } while (H_IS_LONG_BUSY(rc) || (rc == H_BUSY));
  463. ibmveth_cleanup(adapter);
  464. return rc;
  465. }
  466. ibmveth_debug_printk("initial replenish cycle\n");
  467. ibmveth_interrupt(netdev->irq, netdev, NULL);
  468. netif_start_queue(netdev);
  469. ibmveth_debug_printk("open complete\n");
  470. return 0;
  471. }
  472. static int ibmveth_close(struct net_device *netdev)
  473. {
  474. struct ibmveth_adapter *adapter = netdev->priv;
  475. long lpar_rc;
  476. ibmveth_debug_printk("close starting\n");
  477. if (!adapter->pool_config)
  478. netif_stop_queue(netdev);
  479. free_irq(netdev->irq, netdev);
  480. do {
  481. lpar_rc = h_free_logical_lan(adapter->vdev->unit_address);
  482. } while (H_IS_LONG_BUSY(lpar_rc) || (lpar_rc == H_BUSY));
  483. if(lpar_rc != H_SUCCESS)
  484. {
  485. ibmveth_error_printk("h_free_logical_lan failed with %lx, continuing with close\n",
  486. lpar_rc);
  487. }
  488. adapter->rx_no_buffer = *(u64*)(((char*)adapter->buffer_list_addr) + 4096 - 8);
  489. ibmveth_cleanup(adapter);
  490. ibmveth_debug_printk("close complete\n");
  491. return 0;
  492. }
  493. static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) {
  494. cmd->supported = (SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg | SUPPORTED_FIBRE);
  495. cmd->advertising = (ADVERTISED_1000baseT_Full | ADVERTISED_Autoneg | ADVERTISED_FIBRE);
  496. cmd->speed = SPEED_1000;
  497. cmd->duplex = DUPLEX_FULL;
  498. cmd->port = PORT_FIBRE;
  499. cmd->phy_address = 0;
  500. cmd->transceiver = XCVR_INTERNAL;
  501. cmd->autoneg = AUTONEG_ENABLE;
  502. cmd->maxtxpkt = 0;
  503. cmd->maxrxpkt = 1;
  504. return 0;
  505. }
  506. static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info) {
  507. strncpy(info->driver, ibmveth_driver_name, sizeof(info->driver) - 1);
  508. strncpy(info->version, ibmveth_driver_version, sizeof(info->version) - 1);
  509. }
  510. static u32 netdev_get_link(struct net_device *dev) {
  511. return 1;
  512. }
  513. static const struct ethtool_ops netdev_ethtool_ops = {
  514. .get_drvinfo = netdev_get_drvinfo,
  515. .get_settings = netdev_get_settings,
  516. .get_link = netdev_get_link,
  517. .get_sg = ethtool_op_get_sg,
  518. .get_tx_csum = ethtool_op_get_tx_csum,
  519. };
  520. static int ibmveth_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
  521. {
  522. return -EOPNOTSUPP;
  523. }
  524. #define page_offset(v) ((unsigned long)(v) & ((1 << 12) - 1))
  525. static int ibmveth_start_xmit(struct sk_buff *skb, struct net_device *netdev)
  526. {
  527. struct ibmveth_adapter *adapter = netdev->priv;
  528. union ibmveth_buf_desc desc[IbmVethMaxSendFrags];
  529. unsigned long lpar_rc;
  530. int nfrags = 0, curfrag;
  531. unsigned long correlator;
  532. unsigned long flags;
  533. unsigned int retry_count;
  534. unsigned int tx_dropped = 0;
  535. unsigned int tx_bytes = 0;
  536. unsigned int tx_packets = 0;
  537. unsigned int tx_send_failed = 0;
  538. unsigned int tx_map_failed = 0;
  539. if ((skb_shinfo(skb)->nr_frags + 1) > IbmVethMaxSendFrags) {
  540. tx_dropped++;
  541. goto out;
  542. }
  543. memset(&desc, 0, sizeof(desc));
  544. /* nfrags = number of frags after the initial fragment */
  545. nfrags = skb_shinfo(skb)->nr_frags;
  546. if(nfrags)
  547. adapter->tx_multidesc_send++;
  548. /* map the initial fragment */
  549. desc[0].fields.length = nfrags ? skb->len - skb->data_len : skb->len;
  550. desc[0].fields.address = dma_map_single(&adapter->vdev->dev, skb->data,
  551. desc[0].fields.length, DMA_TO_DEVICE);
  552. desc[0].fields.valid = 1;
  553. if(dma_mapping_error(desc[0].fields.address)) {
  554. ibmveth_error_printk("tx: unable to map initial fragment\n");
  555. tx_map_failed++;
  556. tx_dropped++;
  557. goto out;
  558. }
  559. curfrag = nfrags;
  560. /* map fragments past the initial portion if there are any */
  561. while(curfrag--) {
  562. skb_frag_t *frag = &skb_shinfo(skb)->frags[curfrag];
  563. desc[curfrag+1].fields.address
  564. = dma_map_single(&adapter->vdev->dev,
  565. page_address(frag->page) + frag->page_offset,
  566. frag->size, DMA_TO_DEVICE);
  567. desc[curfrag+1].fields.length = frag->size;
  568. desc[curfrag+1].fields.valid = 1;
  569. if(dma_mapping_error(desc[curfrag+1].fields.address)) {
  570. ibmveth_error_printk("tx: unable to map fragment %d\n", curfrag);
  571. tx_map_failed++;
  572. tx_dropped++;
  573. /* Free all the mappings we just created */
  574. while(curfrag < nfrags) {
  575. dma_unmap_single(&adapter->vdev->dev,
  576. desc[curfrag+1].fields.address,
  577. desc[curfrag+1].fields.length,
  578. DMA_TO_DEVICE);
  579. curfrag++;
  580. }
  581. goto out;
  582. }
  583. }
  584. /* send the frame. Arbitrarily set retrycount to 1024 */
  585. correlator = 0;
  586. retry_count = 1024;
  587. do {
  588. lpar_rc = h_send_logical_lan(adapter->vdev->unit_address,
  589. desc[0].desc,
  590. desc[1].desc,
  591. desc[2].desc,
  592. desc[3].desc,
  593. desc[4].desc,
  594. desc[5].desc,
  595. correlator,
  596. &correlator);
  597. } while ((lpar_rc == H_BUSY) && (retry_count--));
  598. if(lpar_rc != H_SUCCESS && lpar_rc != H_DROPPED) {
  599. int i;
  600. ibmveth_error_printk("tx: h_send_logical_lan failed with rc=%ld\n", lpar_rc);
  601. for(i = 0; i < 6; i++) {
  602. ibmveth_error_printk("tx: desc[%i] valid=%d, len=%d, address=0x%d\n", i,
  603. desc[i].fields.valid, desc[i].fields.length, desc[i].fields.address);
  604. }
  605. tx_send_failed++;
  606. tx_dropped++;
  607. } else {
  608. tx_packets++;
  609. tx_bytes += skb->len;
  610. netdev->trans_start = jiffies;
  611. }
  612. do {
  613. dma_unmap_single(&adapter->vdev->dev,
  614. desc[nfrags].fields.address,
  615. desc[nfrags].fields.length, DMA_TO_DEVICE);
  616. } while(--nfrags >= 0);
  617. out: spin_lock_irqsave(&adapter->stats_lock, flags);
  618. adapter->stats.tx_dropped += tx_dropped;
  619. adapter->stats.tx_bytes += tx_bytes;
  620. adapter->stats.tx_packets += tx_packets;
  621. adapter->tx_send_failed += tx_send_failed;
  622. adapter->tx_map_failed += tx_map_failed;
  623. spin_unlock_irqrestore(&adapter->stats_lock, flags);
  624. dev_kfree_skb(skb);
  625. return 0;
  626. }
  627. static int ibmveth_poll(struct net_device *netdev, int *budget)
  628. {
  629. struct ibmveth_adapter *adapter = netdev->priv;
  630. int max_frames_to_process = netdev->quota;
  631. int frames_processed = 0;
  632. int more_work = 1;
  633. unsigned long lpar_rc;
  634. restart_poll:
  635. do {
  636. struct net_device *netdev = adapter->netdev;
  637. if(ibmveth_rxq_pending_buffer(adapter)) {
  638. struct sk_buff *skb;
  639. rmb();
  640. if(!ibmveth_rxq_buffer_valid(adapter)) {
  641. wmb(); /* suggested by larson1 */
  642. adapter->rx_invalid_buffer++;
  643. ibmveth_debug_printk("recycling invalid buffer\n");
  644. ibmveth_rxq_recycle_buffer(adapter);
  645. } else {
  646. int length = ibmveth_rxq_frame_length(adapter);
  647. int offset = ibmveth_rxq_frame_offset(adapter);
  648. skb = ibmveth_rxq_get_buffer(adapter);
  649. ibmveth_rxq_harvest_buffer(adapter);
  650. skb_reserve(skb, offset);
  651. skb_put(skb, length);
  652. skb->dev = netdev;
  653. skb->protocol = eth_type_trans(skb, netdev);
  654. netif_receive_skb(skb); /* send it up */
  655. adapter->stats.rx_packets++;
  656. adapter->stats.rx_bytes += length;
  657. frames_processed++;
  658. netdev->last_rx = jiffies;
  659. }
  660. } else {
  661. more_work = 0;
  662. }
  663. } while(more_work && (frames_processed < max_frames_to_process));
  664. ibmveth_replenish_task(adapter);
  665. if(more_work) {
  666. /* more work to do - return that we are not done yet */
  667. netdev->quota -= frames_processed;
  668. *budget -= frames_processed;
  669. return 1;
  670. }
  671. /* we think we are done - reenable interrupts, then check once more to make sure we are done */
  672. lpar_rc = h_vio_signal(adapter->vdev->unit_address, VIO_IRQ_ENABLE);
  673. ibmveth_assert(lpar_rc == H_SUCCESS);
  674. netif_rx_complete(netdev);
  675. if(ibmveth_rxq_pending_buffer(adapter) && netif_rx_reschedule(netdev, frames_processed))
  676. {
  677. lpar_rc = h_vio_signal(adapter->vdev->unit_address, VIO_IRQ_DISABLE);
  678. ibmveth_assert(lpar_rc == H_SUCCESS);
  679. more_work = 1;
  680. goto restart_poll;
  681. }
  682. netdev->quota -= frames_processed;
  683. *budget -= frames_processed;
  684. /* we really are done */
  685. return 0;
  686. }
  687. static irqreturn_t ibmveth_interrupt(int irq, void *dev_instance, struct pt_regs *regs)
  688. {
  689. struct net_device *netdev = dev_instance;
  690. struct ibmveth_adapter *adapter = netdev->priv;
  691. unsigned long lpar_rc;
  692. if(netif_rx_schedule_prep(netdev)) {
  693. lpar_rc = h_vio_signal(adapter->vdev->unit_address, VIO_IRQ_DISABLE);
  694. ibmveth_assert(lpar_rc == H_SUCCESS);
  695. __netif_rx_schedule(netdev);
  696. }
  697. return IRQ_HANDLED;
  698. }
  699. static struct net_device_stats *ibmveth_get_stats(struct net_device *dev)
  700. {
  701. struct ibmveth_adapter *adapter = dev->priv;
  702. return &adapter->stats;
  703. }
  704. static void ibmveth_set_multicast_list(struct net_device *netdev)
  705. {
  706. struct ibmveth_adapter *adapter = netdev->priv;
  707. unsigned long lpar_rc;
  708. if((netdev->flags & IFF_PROMISC) || (netdev->mc_count > adapter->mcastFilterSize)) {
  709. lpar_rc = h_multicast_ctrl(adapter->vdev->unit_address,
  710. IbmVethMcastEnableRecv |
  711. IbmVethMcastDisableFiltering,
  712. 0);
  713. if(lpar_rc != H_SUCCESS) {
  714. ibmveth_error_printk("h_multicast_ctrl rc=%ld when entering promisc mode\n", lpar_rc);
  715. }
  716. } else {
  717. struct dev_mc_list *mclist = netdev->mc_list;
  718. int i;
  719. /* clear the filter table & disable filtering */
  720. lpar_rc = h_multicast_ctrl(adapter->vdev->unit_address,
  721. IbmVethMcastEnableRecv |
  722. IbmVethMcastDisableFiltering |
  723. IbmVethMcastClearFilterTable,
  724. 0);
  725. if(lpar_rc != H_SUCCESS) {
  726. ibmveth_error_printk("h_multicast_ctrl rc=%ld when attempting to clear filter table\n", lpar_rc);
  727. }
  728. /* add the addresses to the filter table */
  729. for(i = 0; i < netdev->mc_count; ++i, mclist = mclist->next) {
  730. // add the multicast address to the filter table
  731. unsigned long mcast_addr = 0;
  732. memcpy(((char *)&mcast_addr)+2, mclist->dmi_addr, 6);
  733. lpar_rc = h_multicast_ctrl(adapter->vdev->unit_address,
  734. IbmVethMcastAddFilter,
  735. mcast_addr);
  736. if(lpar_rc != H_SUCCESS) {
  737. ibmveth_error_printk("h_multicast_ctrl rc=%ld when adding an entry to the filter table\n", lpar_rc);
  738. }
  739. }
  740. /* re-enable filtering */
  741. lpar_rc = h_multicast_ctrl(adapter->vdev->unit_address,
  742. IbmVethMcastEnableFiltering,
  743. 0);
  744. if(lpar_rc != H_SUCCESS) {
  745. ibmveth_error_printk("h_multicast_ctrl rc=%ld when enabling filtering\n", lpar_rc);
  746. }
  747. }
  748. }
  749. static int ibmveth_change_mtu(struct net_device *dev, int new_mtu)
  750. {
  751. struct ibmveth_adapter *adapter = dev->priv;
  752. int new_mtu_oh = new_mtu + IBMVETH_BUFF_OH;
  753. int i;
  754. if (new_mtu < IBMVETH_MAX_MTU)
  755. return -EINVAL;
  756. /* Look for an active buffer pool that can hold the new MTU */
  757. for(i = 0; i<IbmVethNumBufferPools; i++) {
  758. if (!adapter->rx_buff_pool[i].active)
  759. continue;
  760. if (new_mtu_oh < adapter->rx_buff_pool[i].buff_size) {
  761. dev->mtu = new_mtu;
  762. return 0;
  763. }
  764. }
  765. return -EINVAL;
  766. }
  767. #ifdef CONFIG_NET_POLL_CONTROLLER
  768. static void ibmveth_poll_controller(struct net_device *dev)
  769. {
  770. ibmveth_replenish_task(dev->priv);
  771. ibmveth_interrupt(dev->irq, dev, NULL);
  772. }
  773. #endif
  774. static int __devinit ibmveth_probe(struct vio_dev *dev, const struct vio_device_id *id)
  775. {
  776. int rc, i;
  777. struct net_device *netdev;
  778. struct ibmveth_adapter *adapter = NULL;
  779. unsigned char *mac_addr_p;
  780. unsigned int *mcastFilterSize_p;
  781. ibmveth_debug_printk_no_adapter("entering ibmveth_probe for UA 0x%x\n",
  782. dev->unit_address);
  783. mac_addr_p = (unsigned char *) vio_get_attribute(dev, VETH_MAC_ADDR, 0);
  784. if(!mac_addr_p) {
  785. printk(KERN_ERR "(%s:%3.3d) ERROR: Can't find VETH_MAC_ADDR "
  786. "attribute\n", __FILE__, __LINE__);
  787. return 0;
  788. }
  789. mcastFilterSize_p= (unsigned int *) vio_get_attribute(dev, VETH_MCAST_FILTER_SIZE, 0);
  790. if(!mcastFilterSize_p) {
  791. printk(KERN_ERR "(%s:%3.3d) ERROR: Can't find "
  792. "VETH_MCAST_FILTER_SIZE attribute\n",
  793. __FILE__, __LINE__);
  794. return 0;
  795. }
  796. netdev = alloc_etherdev(sizeof(struct ibmveth_adapter));
  797. if(!netdev)
  798. return -ENOMEM;
  799. SET_MODULE_OWNER(netdev);
  800. adapter = netdev->priv;
  801. memset(adapter, 0, sizeof(adapter));
  802. dev->dev.driver_data = netdev;
  803. adapter->vdev = dev;
  804. adapter->netdev = netdev;
  805. adapter->mcastFilterSize= *mcastFilterSize_p;
  806. adapter->pool_config = 0;
  807. /* Some older boxes running PHYP non-natively have an OF that
  808. returns a 8-byte local-mac-address field (and the first
  809. 2 bytes have to be ignored) while newer boxes' OF return
  810. a 6-byte field. Note that IEEE 1275 specifies that
  811. local-mac-address must be a 6-byte field.
  812. The RPA doc specifies that the first byte must be 10b, so
  813. we'll just look for it to solve this 8 vs. 6 byte field issue */
  814. if ((*mac_addr_p & 0x3) != 0x02)
  815. mac_addr_p += 2;
  816. adapter->mac_addr = 0;
  817. memcpy(&adapter->mac_addr, mac_addr_p, 6);
  818. adapter->liobn = dev->iommu_table->it_index;
  819. netdev->irq = dev->irq;
  820. netdev->open = ibmveth_open;
  821. netdev->poll = ibmveth_poll;
  822. netdev->weight = 16;
  823. netdev->stop = ibmveth_close;
  824. netdev->hard_start_xmit = ibmveth_start_xmit;
  825. netdev->get_stats = ibmveth_get_stats;
  826. netdev->set_multicast_list = ibmveth_set_multicast_list;
  827. netdev->do_ioctl = ibmveth_ioctl;
  828. netdev->ethtool_ops = &netdev_ethtool_ops;
  829. netdev->change_mtu = ibmveth_change_mtu;
  830. SET_NETDEV_DEV(netdev, &dev->dev);
  831. #ifdef CONFIG_NET_POLL_CONTROLLER
  832. netdev->poll_controller = ibmveth_poll_controller;
  833. #endif
  834. netdev->features |= NETIF_F_LLTX;
  835. spin_lock_init(&adapter->stats_lock);
  836. memcpy(&netdev->dev_addr, &adapter->mac_addr, netdev->addr_len);
  837. for(i = 0; i<IbmVethNumBufferPools; i++) {
  838. struct kobject *kobj = &adapter->rx_buff_pool[i].kobj;
  839. ibmveth_init_buffer_pool(&adapter->rx_buff_pool[i], i,
  840. pool_count[i], pool_size[i],
  841. pool_active[i]);
  842. kobj->parent = &dev->dev.kobj;
  843. sprintf(kobj->name, "pool%d", i);
  844. kobj->ktype = &ktype_veth_pool;
  845. kobject_register(kobj);
  846. }
  847. ibmveth_debug_printk("adapter @ 0x%p\n", adapter);
  848. adapter->buffer_list_dma = DMA_ERROR_CODE;
  849. adapter->filter_list_dma = DMA_ERROR_CODE;
  850. adapter->rx_queue.queue_dma = DMA_ERROR_CODE;
  851. ibmveth_debug_printk("registering netdev...\n");
  852. rc = register_netdev(netdev);
  853. if(rc) {
  854. ibmveth_debug_printk("failed to register netdev rc=%d\n", rc);
  855. free_netdev(netdev);
  856. return rc;
  857. }
  858. ibmveth_debug_printk("registered\n");
  859. ibmveth_proc_register_adapter(adapter);
  860. return 0;
  861. }
  862. static int __devexit ibmveth_remove(struct vio_dev *dev)
  863. {
  864. struct net_device *netdev = dev->dev.driver_data;
  865. struct ibmveth_adapter *adapter = netdev->priv;
  866. int i;
  867. for(i = 0; i<IbmVethNumBufferPools; i++)
  868. kobject_unregister(&adapter->rx_buff_pool[i].kobj);
  869. unregister_netdev(netdev);
  870. ibmveth_proc_unregister_adapter(adapter);
  871. free_netdev(netdev);
  872. return 0;
  873. }
  874. #ifdef CONFIG_PROC_FS
  875. static void ibmveth_proc_register_driver(void)
  876. {
  877. ibmveth_proc_dir = proc_mkdir(IBMVETH_PROC_DIR, NULL);
  878. if (ibmveth_proc_dir) {
  879. SET_MODULE_OWNER(ibmveth_proc_dir);
  880. }
  881. }
  882. static void ibmveth_proc_unregister_driver(void)
  883. {
  884. remove_proc_entry(IBMVETH_PROC_DIR, NULL);
  885. }
  886. static void *ibmveth_seq_start(struct seq_file *seq, loff_t *pos)
  887. {
  888. if (*pos == 0) {
  889. return (void *)1;
  890. } else {
  891. return NULL;
  892. }
  893. }
  894. static void *ibmveth_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  895. {
  896. ++*pos;
  897. return NULL;
  898. }
  899. static void ibmveth_seq_stop(struct seq_file *seq, void *v)
  900. {
  901. }
  902. static int ibmveth_seq_show(struct seq_file *seq, void *v)
  903. {
  904. struct ibmveth_adapter *adapter = seq->private;
  905. char *current_mac = ((char*) &adapter->netdev->dev_addr);
  906. char *firmware_mac = ((char*) &adapter->mac_addr) ;
  907. seq_printf(seq, "%s %s\n\n", ibmveth_driver_string, ibmveth_driver_version);
  908. seq_printf(seq, "Unit Address: 0x%x\n", adapter->vdev->unit_address);
  909. seq_printf(seq, "LIOBN: 0x%lx\n", adapter->liobn);
  910. seq_printf(seq, "Current MAC: %02X:%02X:%02X:%02X:%02X:%02X\n",
  911. current_mac[0], current_mac[1], current_mac[2],
  912. current_mac[3], current_mac[4], current_mac[5]);
  913. seq_printf(seq, "Firmware MAC: %02X:%02X:%02X:%02X:%02X:%02X\n",
  914. firmware_mac[0], firmware_mac[1], firmware_mac[2],
  915. firmware_mac[3], firmware_mac[4], firmware_mac[5]);
  916. seq_printf(seq, "\nAdapter Statistics:\n");
  917. seq_printf(seq, " TX: skbuffs linearized: %ld\n", adapter->tx_linearized);
  918. seq_printf(seq, " multi-descriptor sends: %ld\n", adapter->tx_multidesc_send);
  919. seq_printf(seq, " skb_linearize failures: %ld\n", adapter->tx_linearize_failed);
  920. seq_printf(seq, " vio_map_single failres: %ld\n", adapter->tx_map_failed);
  921. seq_printf(seq, " send failures: %ld\n", adapter->tx_send_failed);
  922. seq_printf(seq, " RX: replenish task cycles: %ld\n", adapter->replenish_task_cycles);
  923. seq_printf(seq, " alloc_skb_failures: %ld\n", adapter->replenish_no_mem);
  924. seq_printf(seq, " add buffer failures: %ld\n", adapter->replenish_add_buff_failure);
  925. seq_printf(seq, " invalid buffers: %ld\n", adapter->rx_invalid_buffer);
  926. seq_printf(seq, " no buffers: %ld\n", adapter->rx_no_buffer);
  927. return 0;
  928. }
  929. static struct seq_operations ibmveth_seq_ops = {
  930. .start = ibmveth_seq_start,
  931. .next = ibmveth_seq_next,
  932. .stop = ibmveth_seq_stop,
  933. .show = ibmveth_seq_show,
  934. };
  935. static int ibmveth_proc_open(struct inode *inode, struct file *file)
  936. {
  937. struct seq_file *seq;
  938. struct proc_dir_entry *proc;
  939. int rc;
  940. rc = seq_open(file, &ibmveth_seq_ops);
  941. if (!rc) {
  942. /* recover the pointer buried in proc_dir_entry data */
  943. seq = file->private_data;
  944. proc = PDE(inode);
  945. seq->private = proc->data;
  946. }
  947. return rc;
  948. }
  949. static struct file_operations ibmveth_proc_fops = {
  950. .owner = THIS_MODULE,
  951. .open = ibmveth_proc_open,
  952. .read = seq_read,
  953. .llseek = seq_lseek,
  954. .release = seq_release,
  955. };
  956. static void ibmveth_proc_register_adapter(struct ibmveth_adapter *adapter)
  957. {
  958. struct proc_dir_entry *entry;
  959. if (ibmveth_proc_dir) {
  960. entry = create_proc_entry(adapter->netdev->name, S_IFREG, ibmveth_proc_dir);
  961. if (!entry) {
  962. ibmveth_error_printk("Cannot create adapter proc entry");
  963. } else {
  964. entry->data = (void *) adapter;
  965. entry->proc_fops = &ibmveth_proc_fops;
  966. SET_MODULE_OWNER(entry);
  967. }
  968. }
  969. return;
  970. }
  971. static void ibmveth_proc_unregister_adapter(struct ibmveth_adapter *adapter)
  972. {
  973. if (ibmveth_proc_dir) {
  974. remove_proc_entry(adapter->netdev->name, ibmveth_proc_dir);
  975. }
  976. }
  977. #else /* CONFIG_PROC_FS */
  978. static void ibmveth_proc_register_adapter(struct ibmveth_adapter *adapter)
  979. {
  980. }
  981. static void ibmveth_proc_unregister_adapter(struct ibmveth_adapter *adapter)
  982. {
  983. }
  984. static void ibmveth_proc_register_driver(void)
  985. {
  986. }
  987. static void ibmveth_proc_unregister_driver(void)
  988. {
  989. }
  990. #endif /* CONFIG_PROC_FS */
  991. static struct attribute veth_active_attr;
  992. static struct attribute veth_num_attr;
  993. static struct attribute veth_size_attr;
  994. static ssize_t veth_pool_show(struct kobject * kobj,
  995. struct attribute * attr, char * buf)
  996. {
  997. struct ibmveth_buff_pool *pool = container_of(kobj,
  998. struct ibmveth_buff_pool,
  999. kobj);
  1000. if (attr == &veth_active_attr)
  1001. return sprintf(buf, "%d\n", pool->active);
  1002. else if (attr == &veth_num_attr)
  1003. return sprintf(buf, "%d\n", pool->size);
  1004. else if (attr == &veth_size_attr)
  1005. return sprintf(buf, "%d\n", pool->buff_size);
  1006. return 0;
  1007. }
  1008. static ssize_t veth_pool_store(struct kobject * kobj, struct attribute * attr,
  1009. const char * buf, size_t count)
  1010. {
  1011. struct ibmveth_buff_pool *pool = container_of(kobj,
  1012. struct ibmveth_buff_pool,
  1013. kobj);
  1014. struct net_device *netdev =
  1015. container_of(kobj->parent, struct device, kobj)->driver_data;
  1016. struct ibmveth_adapter *adapter = netdev->priv;
  1017. long value = simple_strtol(buf, NULL, 10);
  1018. long rc;
  1019. if (attr == &veth_active_attr) {
  1020. if (value && !pool->active) {
  1021. if(ibmveth_alloc_buffer_pool(pool)) {
  1022. ibmveth_error_printk("unable to alloc pool\n");
  1023. return -ENOMEM;
  1024. }
  1025. pool->active = 1;
  1026. adapter->pool_config = 1;
  1027. ibmveth_close(netdev);
  1028. adapter->pool_config = 0;
  1029. if ((rc = ibmveth_open(netdev)))
  1030. return rc;
  1031. } else if (!value && pool->active) {
  1032. int mtu = netdev->mtu + IBMVETH_BUFF_OH;
  1033. int i;
  1034. /* Make sure there is a buffer pool with buffers that
  1035. can hold a packet of the size of the MTU */
  1036. for(i = 0; i<IbmVethNumBufferPools; i++) {
  1037. if (pool == &adapter->rx_buff_pool[i])
  1038. continue;
  1039. if (!adapter->rx_buff_pool[i].active)
  1040. continue;
  1041. if (mtu < adapter->rx_buff_pool[i].buff_size) {
  1042. pool->active = 0;
  1043. h_free_logical_lan_buffer(adapter->
  1044. vdev->
  1045. unit_address,
  1046. pool->
  1047. buff_size);
  1048. }
  1049. }
  1050. if (pool->active) {
  1051. ibmveth_error_printk("no active pool >= MTU\n");
  1052. return -EPERM;
  1053. }
  1054. }
  1055. } else if (attr == &veth_num_attr) {
  1056. if (value <= 0 || value > IBMVETH_MAX_POOL_COUNT)
  1057. return -EINVAL;
  1058. else {
  1059. adapter->pool_config = 1;
  1060. ibmveth_close(netdev);
  1061. adapter->pool_config = 0;
  1062. pool->size = value;
  1063. if ((rc = ibmveth_open(netdev)))
  1064. return rc;
  1065. }
  1066. } else if (attr == &veth_size_attr) {
  1067. if (value <= IBMVETH_BUFF_OH || value > IBMVETH_MAX_BUF_SIZE)
  1068. return -EINVAL;
  1069. else {
  1070. adapter->pool_config = 1;
  1071. ibmveth_close(netdev);
  1072. adapter->pool_config = 0;
  1073. pool->buff_size = value;
  1074. if ((rc = ibmveth_open(netdev)))
  1075. return rc;
  1076. }
  1077. }
  1078. /* kick the interrupt handler to allocate/deallocate pools */
  1079. ibmveth_interrupt(netdev->irq, netdev, NULL);
  1080. return count;
  1081. }
  1082. #define ATTR(_name, _mode) \
  1083. struct attribute veth_##_name##_attr = { \
  1084. .name = __stringify(_name), .mode = _mode, .owner = THIS_MODULE \
  1085. };
  1086. static ATTR(active, 0644);
  1087. static ATTR(num, 0644);
  1088. static ATTR(size, 0644);
  1089. static struct attribute * veth_pool_attrs[] = {
  1090. &veth_active_attr,
  1091. &veth_num_attr,
  1092. &veth_size_attr,
  1093. NULL,
  1094. };
  1095. static struct sysfs_ops veth_pool_ops = {
  1096. .show = veth_pool_show,
  1097. .store = veth_pool_store,
  1098. };
  1099. static struct kobj_type ktype_veth_pool = {
  1100. .release = NULL,
  1101. .sysfs_ops = &veth_pool_ops,
  1102. .default_attrs = veth_pool_attrs,
  1103. };
  1104. static struct vio_device_id ibmveth_device_table[] __devinitdata= {
  1105. { "network", "IBM,l-lan"},
  1106. { "", "" }
  1107. };
  1108. MODULE_DEVICE_TABLE(vio, ibmveth_device_table);
  1109. static struct vio_driver ibmveth_driver = {
  1110. .id_table = ibmveth_device_table,
  1111. .probe = ibmveth_probe,
  1112. .remove = ibmveth_remove,
  1113. .driver = {
  1114. .name = ibmveth_driver_name,
  1115. .owner = THIS_MODULE,
  1116. }
  1117. };
  1118. static int __init ibmveth_module_init(void)
  1119. {
  1120. ibmveth_printk("%s: %s %s\n", ibmveth_driver_name, ibmveth_driver_string, ibmveth_driver_version);
  1121. ibmveth_proc_register_driver();
  1122. return vio_register_driver(&ibmveth_driver);
  1123. }
  1124. static void __exit ibmveth_module_exit(void)
  1125. {
  1126. vio_unregister_driver(&ibmveth_driver);
  1127. ibmveth_proc_unregister_driver();
  1128. }
  1129. module_init(ibmveth_module_init);
  1130. module_exit(ibmveth_module_exit);