Started IB driver rewrite
[people/sha0/gpxe.git] / src / drivers / net / mlx_ipoib / mt25218.c
1 /**************************************************************************
2 Etherboot -  BOOTP/TFTP Bootstrap Program
3 Skeleton NIC driver for Etherboot
4 ***************************************************************************/
5
6 /*
7  * This program is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU General Public License as
9  * published by the Free Software Foundation; either version 2, or (at
10  * your option) any later version.
11  */
12
13 #include <errno.h>
14 #include <gpxe/pci.h>
15 #include <gpxe/iobuf.h>
16 #include <gpxe/netdevice.h>
17 #include <gpxe/infiniband.h>
18
19 struct mlx_nic {
20 };
21
22 /* to get some global routines like printf */
23 #include "etherboot.h"
24 /* to get the interface to the body of the program */
25 #include "nic.h"
26
27 #include "mt_version.c"
28 #include "mt25218_imp.c"
29
30 /* NIC specific static variables go here */
31
32 int prompt_key(int secs, unsigned char *ch_p)
33 {
34         unsigned long tmo;
35         unsigned char ch;
36
37         for (tmo = currticks() + secs * TICKS_PER_SEC; currticks() < tmo;) {
38                 if (iskey()) {
39                         ch = getchar();
40                         /* toupper does not work ... */
41                         if (ch == 'v')
42                                 ch = 'V';
43                         if (ch == 'i')
44                                 ch = 'I';
45                         if ((ch=='V') || (ch=='I')) {
46                                 *ch_p = ch;
47                                 return 1;
48                         }
49                 }
50         }
51
52         return 0;
53 }
54
55 /**************************************************************************
56 IRQ - handle interrupts
57 ***************************************************************************/
58 static void mt25218_irq(struct nic *nic, irq_action_t action)
59 {
60         /* This routine is somewhat optional.  Etherboot itself
61          * doesn't use interrupts, but they are required under some
62          * circumstances when we're acting as a PXE stack.
63          *
64          * If you don't implement this routine, the only effect will
65          * be that your driver cannot be used via Etherboot's UNDI
66          * API.  This won't affect programs that use only the UDP
67          * portion of the PXE API, such as pxelinux.
68          */
69
70         if (0) {
71                 nic = NULL;
72         }
73         switch (action) {
74         case DISABLE:
75         case ENABLE:
76                 /* Set receive interrupt enabled/disabled state */
77                 /*
78                    outb ( action == ENABLE ? IntrMaskEnabled : IntrMaskDisabled,
79                    nic->ioaddr + IntrMaskRegister );
80                  */
81                 break;
82         case FORCE:
83                 /* Force NIC to generate a receive interrupt */
84                 /*
85                    outb ( ForceInterrupt, nic->ioaddr + IntrForceRegister );
86                  */
87                 break;
88         }
89 }
90
91 /**************************************************************************
92 POLL - Wait for a frame
93 ***************************************************************************/
94 static int mt25218_poll(struct nic *nic, int retrieve)
95 {
96         /* Work out whether or not there's an ethernet packet ready to
97          * read.  Return 0 if not.
98          */
99         /* 
100            if ( ! <packet_ready> ) return 0;
101          */
102
103         /* retrieve==0 indicates that we are just checking for the
104          * presence of a packet but don't want to read it just yet.
105          */
106         /*
107            if ( ! retrieve ) return 1;
108          */
109
110         /* Copy data to nic->packet.  Data should include the
111          * link-layer header (dest MAC, source MAC, type).
112          * Store length of data in nic->packetlen.
113          * Return true to indicate a packet has been read.
114          */
115         /* 
116            nic->packetlen = <packet_length>;
117            memcpy ( nic->packet, <packet_data>, <packet_length> );
118            return 1;
119          */
120         unsigned int size;
121         int rc;
122         rc = poll_imp(nic, retrieve, &size);
123         if (rc) {
124                 return 0;
125         }
126
127         if (size == 0) {
128                 return 0;
129         }
130
131         nic->packetlen = size;
132
133         return 1;
134 }
135
136 /**************************************************************************
137 TRANSMIT - Transmit a frame
138 ***************************************************************************/
139 static void mt25218_transmit(struct nic *nic, const char *dest, /* Destination */
140                              unsigned int type, /* Type */
141                              unsigned int size, /* size */
142                              const char *packet)
143 {                               /* Packet */
144         int rc;
145
146         /* Transmit packet to dest MAC address.  You will need to
147          * construct the link-layer header (dest MAC, source MAC,
148          * type).
149          */
150         if (nic) {
151                 rc = transmit_imp(dest, type, packet, size);
152                 if (rc)
153                         eprintf("tranmit error");
154         }
155 }
156
157 /**
158  * Open network device
159  *
160  * @v netdev            Network device
161  * @ret rc              Return status code
162  */
163 static int mlx_open ( struct net_device *netdev ) {
164         return 0;
165 }
166
167 /**
168  * Close network device
169  *
170  * @v netdev            Network device
171  */
172 static void mlx_close ( struct net_device *netdev ) {
173 }
174
175 #warning "Broadcast address?"
176 static uint8_t ib_broadcast[IB_ALEN] = { 0xff, };
177
178
179 /**
180  * Transmit packet
181  *
182  * @v netdev            Network device
183  * @v iobuf             I/O buffer
184  * @ret rc              Return status code
185  */
186 static int mlx_transmit ( struct net_device *netdev,
187                           struct io_buffer *iobuf ) {
188         struct ibhdr *ibhdr = iobuf->data;
189
190         DBG ( "Sending packet:\n" );
191         //      DBG_HD ( iobuf->data, iob_len ( iobuf ) );
192
193         DBG ( "Peer:\n" );
194         DBG_HD ( &ibhdr->peer[0], IB_ALEN );
195         DBG ( "Bcast:\n" );
196         DBG_HD ( &ib_broadcast[0], IB_ALEN );
197
198         iob_pull ( iobuf, sizeof ( *ibhdr ) );  
199
200         if ( memcmp ( ibhdr->peer, ib_broadcast, IB_ALEN ) == 0 ) {
201                 printf ( "Sending broadcast packet\n" );
202                 return send_bcast_packet ( ibhdr->proto, iobuf->data,
203                                            iob_len ( iobuf ) );
204         } else {
205                 printf ( "Sending unicast packet\n" );
206                 return send_ucast_packet ( ibhdr->peer, ibhdr->proto,
207                                            iobuf->data, iob_len ( iobuf ) );
208         }
209 }
210
211 /**
212  * Poll for completed and received packets
213  *
214  * @v netdev            Network device
215  */
216 static void mlx_poll ( struct net_device *netdev ) {
217         struct ib_cqe_st ib_cqe;
218         uint8_t num_cqes;
219         unsigned int len;
220         struct io_buffer *iobuf;
221         void *buf;
222         int rc;
223
224         if ( ( rc = poll_error_buf() ) != 0 ) {
225                 DBG ( "poll_error_buf() failed: %s\n", strerror ( rc ) );
226                 return;
227         }
228
229         if ( ( rc = drain_eq() ) != 0 ) {
230                 DBG ( "drain_eq() failed: %s\n", strerror ( rc ) );
231                 return;
232         }
233
234         if ( ( rc = ib_poll_cq ( ipoib_data.rcv_cqh, &ib_cqe,
235                                  &num_cqes ) ) != 0 ) {
236                 DBG ( "ib_poll_cq() failed: %s\n", strerror ( rc ) );
237                 return;
238         }
239
240         if ( ! num_cqes )
241                 return;
242
243         if ( ib_cqe.is_error ) {
244                 DBG ( "cqe error\n" );
245                 free_wqe ( ib_cqe.wqe );
246                 return;
247         }
248
249         len = ib_cqe.count;
250         iobuf = alloc_iob ( len );
251         if ( ! iobuf ) {
252                 DBG ( "out of memory\n" );
253                 free_wqe ( ib_cqe.wqe );
254                 return;
255         }
256         memcpy ( iob_put ( iobuf, len ), buf, len );
257         DBG ( "Received packet:\n" );
258         DBG_HD ( iobuf->data, iob_len ( iobuf ) );
259
260         netdev_rx ( netdev, iobuf );
261
262         free_wqe ( ib_cqe.wqe );
263 }
264
265 /**
266  * Enable or disable interrupts
267  *
268  * @v netdev            Network device
269  * @v enable            Interrupts should be enabled
270  */
271 static void mlx_irq ( struct net_device *netdev, int enable ) {
272 }
273
274 static struct net_device_operations mlx_operations = {
275         .open           = mlx_open,
276         .close          = mlx_close,
277         .transmit       = mlx_transmit,
278         .poll           = mlx_poll,
279         .irq            = mlx_irq,
280 };
281
282 /**************************************************************************
283 DISABLE - Turn off ethernet interface
284 ***************************************************************************/
285 static void mt25218_disable(struct nic *nic)
286 {
287         /* put the card in its initial state */
288         /* This function serves 3 purposes.
289          * This disables DMA and interrupts so we don't receive
290          *  unexpected packets or interrupts from the card after
291          *  etherboot has finished. 
292          * This frees resources so etherboot may use
293          *  this driver on another interface
294          * This allows etherboot to reinitialize the interface
295          *  if something is something goes wrong.
296          */
297         if (nic || 1) {         // ????
298                 disable_imp();
299         }
300 }
301
302 /**
303  * Remove PCI device
304  *
305  * @v pci               PCI device
306  */
307 static void mlx_remove ( struct pci_device *pci ) {
308         struct net_device *netdev = pci_get_drvdata ( pci );
309         struct mlx_nic *mlx = netdev->priv;
310
311         unregister_netdev ( netdev );
312         ipoib_close(0);
313         netdev_nullify ( netdev );
314         netdev_put ( netdev );
315 }
316
317 static struct nic_operations mt25218_operations = {
318         .connect        = dummy_connect,
319         .poll           = mt25218_poll,
320         .transmit       = mt25218_transmit,
321         .irq            = mt25218_irq,
322 };
323
324 /**************************************************************************
325 PROBE - Look for an adapter, this routine's visible to the outside
326 ***************************************************************************/
327
328 static int mt25218_probe(struct nic *nic, struct pci_device *pci)
329 {
330         int rc;
331         unsigned char user_request;
332
333         if (pci->vendor != MELLANOX_VENDOR_ID) {
334                 eprintf("");
335                 return 0;
336         }
337
338         printf("\n");
339         printf("Mellanox Technologies LTD - Boot over IB implementaion\n");
340         printf("Build version = %s\n\n", build_revision);
341
342         verbose_messages = 0;
343         print_info = 0;
344         printf("Press within 3 seconds:\n");
345         printf("V - to increase verbosity\n");
346         printf("I - to print information\n");
347         if (prompt_key(3, &user_request)) {
348                 if (user_request == 'V') {
349                         printf("User selected verbose messages\n");
350                         verbose_messages = 1;
351                 }
352                 else if (user_request == 'I') {
353                         printf("User selected to print information\n");
354                         print_info = 1;
355                 }
356         }
357         printf("\n");
358
359         adjust_pci_device(pci);
360
361         nic->priv_data = NULL;
362         rc = probe_imp(pci, nic);
363
364         /* give the user a chance to look at the info */
365         if (print_info)
366                 sleep(5);
367
368         if (!rc) {
369                 /* store NIC parameters */
370                 nic->ioaddr = pci->ioaddr & ~3;
371                 nic->irqno = pci->irq;
372                 /* point to NIC specific routines */
373                 nic->nic_op = &mt25218_operations;
374
375                 uint8_t fixed_node_addr[ETH_ALEN] = { 0x00, 0x02, 0xc9,
376                                                       0x20, 0xf5, 0x95 };
377                 memcpy ( nic->node_addr, fixed_node_addr, ETH_ALEN );
378
379                 return 1;
380         }
381         /* else */
382         return 0;
383 }
384
385 /**
386  * Probe PCI device
387  *
388  * @v pci               PCI device
389  * @v id                PCI ID
390  * @ret rc              Return status code
391  */
392 static int mlx_probe ( struct pci_device *pci,
393                        const struct pci_device_id *id __unused ) {
394         struct net_device *netdev;
395         struct mlx_nic *mlx;
396         int rc;
397
398         /* Allocate net device */
399         netdev = alloc_ibdev ( sizeof ( *mlx ) );
400         if ( ! netdev )
401                 return -ENOMEM;
402         netdev_init ( netdev, &mlx_operations );
403         mlx = netdev->priv;
404         pci_set_drvdata ( pci, netdev );
405         netdev->dev = &pci->dev;
406         memset ( mlx, 0, sizeof ( *mlx ) );
407
408         /* Fix up PCI device */
409         adjust_pci_device ( pci );
410
411         /* Initialise hardware */
412         if ( ( rc = ipoib_init ( pci ) ) != 0 )
413                 goto err_ipoib_init;
414         memcpy ( netdev->ll_addr, ipoib_data.port_gid_raw, IB_ALEN );
415
416         /* Register network device */
417         if ( ( rc = register_netdev ( netdev ) ) != 0 )
418                 goto err_register_netdev;
419
420         return 0;
421
422  err_register_netdev:
423  err_ipoib_init:
424         ipoib_close(0);
425         netdev_nullify ( netdev );
426         netdev_put ( netdev );
427         return rc;
428 }
429
430 static struct pci_device_id mlx_nics[] = {
431         PCI_ROM(0x15b3, 0x6282, "MT25218", "MT25218 HCA driver"),
432         PCI_ROM(0x15b3, 0x6274, "MT25204", "MT25204 HCA driver"),
433 };
434
435 struct pci_driver mlx_driver __pci_driver = {
436         .ids = mlx_nics,
437         .id_count = ( sizeof ( mlx_nics ) / sizeof ( mlx_nics[0] ) ),
438         .probe = mlx_probe,
439         .remove = mlx_remove,
440 };