1 /* ----------------------------------------------------------------------- *
2 *
3 * Copyright 2008 H. Peter Anvin - All Rights Reserved
4 * Copyright 2009 Intel Corporation; author: H. Peter Anvin
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
9 * Boston MA 02110-1301, USA; either version 2 of the License, or
10 * (at your option) any later version; incorporated herein by reference.
11 *
12 * ----------------------------------------------------------------------- */
13
14 #include <stdio.h>
15 #include <string.h>
16 #include <core.h>
17 #include <fs.h>
18 #include <minmax.h>
19 #include <sys/cpu.h>
20 #include "pxe.h"
21
pxe_idle_poll(void)22 static int pxe_idle_poll(void)
23 {
24 static __lowmem char junk_pkt[PKTBUF_SIZE];
25 static __lowmem t_PXENV_UDP_READ read_buf;
26
27 memset(&read_buf, 0, sizeof read_buf);
28
29 read_buf.src_ip = 0; /* Any destination */
30 read_buf.dest_ip = IPInfo.myip;
31 read_buf.s_port = 0; /* Any source port */
32 read_buf.d_port = htons(9); /* Discard port (not used...) */
33 read_buf.buffer_size = sizeof junk_pkt;
34 read_buf.buffer = FAR_PTR(junk_pkt);
35
36 pxe_call(PXENV_UDP_READ, &read_buf);
37
38 return 0;
39 }
40
pxe_detect_nic_type(void)41 static uint32_t pxe_detect_nic_type(void)
42 {
43 static __lowmem t_PXENV_UNDI_GET_NIC_TYPE nic_type;
44
45 if (pxe_call(PXENV_UNDI_GET_NIC_TYPE, &nic_type))
46 return -1; /* Unknown NIC */
47
48 if (nic_type.NicType != PCI_NIC && nic_type.NicType != CardBus_NIC)
49 return -1; /* Not a PCI NIC */
50
51 /*
52 * Return VID:DID as a single number, with the VID in the high word
53 * -- this is opposite from the usual order, but it makes it easier to
54 * enforce that the table is sorted.
55 */
56 return (nic_type.info.pci.Vendor_ID << 16) + nic_type.info.pci.Dev_ID;
57 }
58
59 #define PCI_DEV(vid, did) (((vid) << 16) + (did))
60
61 /* This array should be sorted!! */
62 static const uint32_t pxe_need_idle_drain[] =
63 {
64 /*
65 * Older Broadcom NICs: they need receive calls on idle to avoid
66 * FIFO stalls.
67 */
68 PCI_DEV(0x14e4, 0x1659), /* BCM5721 */
69 PCI_DEV(0x14e4, 0x165a), /* BCM5722 */
70 PCI_DEV(0x14e4, 0x165b), /* BCM5723 */
71 PCI_DEV(0x14e4, 0x1668), /* BCM5714 */
72 PCI_DEV(0x14e4, 0x1669), /* BCM5714S */
73 PCI_DEV(0x14e4, 0x166a), /* BCM5780 */
74 PCI_DEV(0x14e4, 0x1673), /* BCM5755M */
75 PCI_DEV(0x14e4, 0x1674), /* BCM5756ME */
76 PCI_DEV(0x14e4, 0x1678), /* BCM5715 */
77 PCI_DEV(0x14e4, 0x1679), /* BCM5715S */
78 PCI_DEV(0x14e4, 0x167b), /* BCM5755 */
79 };
80
pxe_idle_init(void)81 void pxe_idle_init(void)
82 {
83 uint32_t dev_id = pxe_detect_nic_type();
84 int l, h;
85 bool found;
86
87 l = 0;
88 h = sizeof pxe_need_idle_drain / sizeof pxe_need_idle_drain[0] - 1;
89
90 found = false;
91 while (h >= l) {
92 int x = (l+h) >> 1;
93 uint32_t id = pxe_need_idle_drain[x];
94
95 if (id == dev_id) {
96 found = true;
97 break;
98 } else if (id < dev_id) {
99 l = x+1;
100 } else {
101 h = x-1;
102 }
103 }
104
105 if (found)
106 idle_hook_func = pxe_idle_poll;
107 }
108
pxe_idle_cleanup(void)109 void pxe_idle_cleanup(void)
110 {
111 idle_hook_func = NULL;
112 }
113