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