Firebee/BaS_gcc
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

rewrite pci_find_classcode() using stored PCI info

Browse Source
This commit is contained in:
Markus Fröschle
2016-12-05 12:13:27 +00:00
parent fda5616124
commit bdc8f4458d
1 changed files with 23 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files

59
BaS_gcc/pci/pci.c
View File

@@ -503,6 +503,23 @@ int32_t pci_find_device(uint16_t device_id, uint16_t vendor_id, int index)
return PCI_DEVICE_NOT_FOUND; return PCI_DEVICE_NOT_FOUND;
} }
static bool match_classcode(uint32_t handle, uint32_t classcode)
{
uint8_t find_mask = (classcode >> 24) & 0xff;
uint32_t value = swpl(pci_read_config_longword(handle, PCICCR));
int i;
for (i = 2; i >= 0; i--) /* loop through mask */
{
if ((find_mask >> i) & 1)
{
if (! (value >> (i * 8)) == (classcode >> (i * 8)))
return false;
}
}
return true;
}
/* /*
* pci_find_classcode(uint32_t classcode, int index) * pci_find_classcode(uint32_t classcode, int index)
* *
@@ -515,53 +532,19 @@ int32_t pci_find_classcode(uint32_t classcode, int index)
{ {
int i; int i;
uint32_t handle; uint32_t handle;
uint32_t ret = PCI_DEVICE_NOT_FOUND;
int n = 0;
uint8_t find_mask;
uint32_t value;
int cmp;
bool match = false;
classcode = swpl(classcode); int n = 0;
find_mask = classcode & 0xff;
classcode >>= 8;
do do
{ {
for (i = 0; (handle = handles[i]) != -1; i++) for (i = 0; (handle = handles[i]) != -1; i++)
{ if (match_classcode(handle, classcode) && n == index)
match = false;
for (cmp = 0; cmp < 3; cmp++)
{
if ((find_mask >> cmp) & 1)
{
value = swpl(pci_read_config_longword(handle, PCICCR));
dbg("compare classcode (0x%x), 0x%x against value (0x%x) 0x%x\r\n",
classcode, (classcode >> (cmp * 8)) & 0xff, value, (value >> (cmp * 8)) & 0xff);
if (((classcode >> (cmp * 8)) & 0xff) == ((value >> (cmp * 8)) & 0xff))
{
if (n == index)
return handle; return handle;
else
n++; n++;
}
else
{
match = false;
goto next;
}
}
else
match = true;
}
next:
;
}
} while (n < index); } while (n < index);
if (match) return PCI_DEVICE_NOT_FOUND;
ret = handle;
return ret;
} }
int32_t pci_hook_interrupt(int32_t handle, void *handler, void *parameter) int32_t pci_hook_interrupt(int32_t handle, void *handler, void *parameter)