Guest User

Untitled

a guest
Apr 4th, 2017
62
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 3.21 KB | None | 0 0
  1. uint8_t pci_read_register(pci_bdf_t addr, uint32_t barOffset, uint32_t offset) {
  2.     uint8_t res;
  3.     barOffset=(0x010+(barOffset*4));
  4.     uint32_t pci_read=pci_config_readd(addr,barOffset);
  5.     uint32_t pci_backup=pci_config_readd(addr,barOffset);
  6.     if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
  7.         pci_config_writed(addr,barOffset,0xFFFFFFF0);
  8.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
  9.         const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  10.         if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
  11.             pci_config_writed(addr,barOffset,pci_backup);
  12.             pci_read=pci_config_readd(addr,barOffset);
  13.             //kprintf("32-Bit-Memory-Ressource\n");
  14.             uint8_t *address=(uint8_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
  15.             kprintf("Offset 0x%x: %b - 0x%x\n",offset,address[offset],address[offset]);
  16.             res=address[offset];
  17.         }
  18.     } else { //IO-Ressource
  19.         pci_config_writed(addr,barOffset,0xFFFFFFFC);
  20.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
  21.         if((pci_read) != 0) {
  22.             const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  23.             const uint highestBit = get_number_of_highest_set_bit(pci_read);
  24.             if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
  25.                 pci_config_writed(addr,barOffset,pci_backup);
  26.                 pci_read=pci_config_readd(addr,barOffset);
  27.                 //kprintf("IO-Ressource\n");
  28.                 uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
  29.                 kprintf("Offset 0x%x: %b - 0x%x\n",offset,inb(address1 + offset),inb(address1 + offset));
  30.                 res=inb(address1 + offset);
  31.             }
  32.         }
  33.     }
  34.     pci_config_writed(addr,barOffset,pci_backup);
  35.     return res;
  36. }
  37.  
  38. void pci_write_register(pci_bdf_t addr, uint32_t barOffset, uint32_t offset, uint8_t val) {
  39.     barOffset=(0x010+(barOffset*4));
  40.     uint32_t pci_read=pci_config_readd(addr,barOffset);
  41.     uint32_t pci_backup=pci_config_readd(addr,barOffset);
  42.     if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
  43.         pci_config_writed(addr,barOffset,0xFFFFFFF0);
  44.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
  45.         const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  46.         if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
  47.             pci_config_writed(addr,barOffset,pci_backup);
  48.             pci_read=pci_config_readd(addr,barOffset);
  49.             //kprintf("32-Bit-Memory-Ressource\n");
  50.             uint8_t *address=(uint8_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
  51.             address[offset]=val;
  52.         }
  53.     } else { //IO-Ressource
  54.         pci_config_writed(addr,barOffset,0xFFFFFFFC);
  55.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
  56.         if((pci_read) != 0) {
  57.             const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  58.             const uint highestBit = get_number_of_highest_set_bit(pci_read);
  59.             if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
  60.                 pci_config_writed(addr,barOffset,pci_backup);
  61.                 pci_read=pci_config_readd(addr,barOffset);
  62.                 //kprintf("IO-Ressource\n");
  63.                 uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
  64.                 outb(address1 + offset,val);
  65.             }
  66.         }
  67.     }
  68.     pci_config_writed(addr,barOffset,pci_backup);
  69. }
Advertisement
Add Comment
Please, Sign In to add comment