Guest User

Untitled

a guest
Apr 13th, 2017
83
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 4.55 KB | None | 0 0
  1. void pci_write_register(pci_bdf_t addr, uint32_t barOffset, uint32_t offset, uint8_t val) {
  2.     barOffset=(0x010+(barOffset*4));
  3.     uint32_t pci_read=pci_config_readd(addr,barOffset);
  4.     uint32_t pci_backup=pci_config_readd(addr,barOffset);
  5.     if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
  6.         pci_config_writed(addr,barOffset,0xFFFFFFF0);
  7.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
  8.         const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  9.         if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
  10.             pci_config_writed(addr,barOffset,pci_backup);
  11.             pci_read=pci_config_readd(addr,barOffset);
  12.             //kprintf("32-Bit-Memory-Ressource\n");
  13.             uint8_t *address=(uint8_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
  14.             address[offset]=val;
  15.         }
  16.     } else { //IO-Ressource
  17.         pci_config_writed(addr,barOffset,0xFFFFFFFC);
  18.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
  19.         if((pci_read) != 0) {
  20.             const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  21.             const uint highestBit = get_number_of_highest_set_bit(pci_read);
  22.             if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
  23.                 pci_config_writed(addr,barOffset,pci_backup);
  24.                 pci_read=pci_config_readd(addr,barOffset);
  25.                 //kprintf("IO-Ressource\n");
  26.                 uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
  27.                 outb(address1 + offset,val);
  28.             }
  29.         }
  30.     }
  31.     pci_config_writed(addr,barOffset,pci_backup);
  32. }
  33.  
  34. void pci_write_register_16(pci_bdf_t addr, uint32_t barOffset, uint32_t offset, uint16_t val) {
  35.     barOffset=(0x010+(barOffset*4));
  36.     uint32_t pci_read=pci_config_readd(addr,barOffset);
  37.     uint32_t pci_backup=pci_config_readd(addr,barOffset);
  38.     if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
  39.         pci_config_writed(addr,barOffset,0xFFFFFFF0);
  40.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
  41.         const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  42.         if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
  43.             pci_config_writed(addr,barOffset,pci_backup);
  44.             pci_read=pci_config_readd(addr,barOffset);
  45.             //kprintf("32-Bit-Memory-Ressource\n");
  46.             uint16_t *address=(uint16_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
  47.             address[offset]=val;
  48.         }
  49.     } else { //IO-Ressource
  50.         pci_config_writed(addr,barOffset,0xFFFFFFFC);
  51.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
  52.         if((pci_read) != 0) {
  53.             const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  54.             const uint highestBit = get_number_of_highest_set_bit(pci_read);
  55.             if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
  56.                 pci_config_writed(addr,barOffset,pci_backup);
  57.                 pci_read=pci_config_readd(addr,barOffset);
  58.                 //kprintf("IO-Ressource\n");
  59.                 uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
  60.                 outw(address1 + offset,val);
  61.             }
  62.         }
  63.     }
  64.     pci_config_writed(addr,barOffset,pci_backup);
  65. }
  66.  
  67. void pci_write_register_32(pci_bdf_t addr, uint32_t barOffset, uint32_t offset, uint32_t val) {
  68.     barOffset=(0x010+(barOffset*4));
  69.     uint32_t pci_read=pci_config_readd(addr,barOffset);
  70.     uint32_t pci_backup=pci_config_readd(addr,barOffset);
  71.     if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
  72.         pci_config_writed(addr,barOffset,0xFFFFFFF0);
  73.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
  74.         const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  75.         if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
  76.             pci_config_writed(addr,barOffset,pci_backup);
  77.             pci_read=pci_config_readd(addr,barOffset);
  78.             //kprintf("32-Bit-Memory-Ressource\n");
  79.             uint32_t *address=(uint32_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
  80.             address[offset]=val;
  81.         }
  82.     } else { //IO-Ressource
  83.         pci_config_writed(addr,barOffset,0xFFFFFFFC);
  84.         pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
  85.         if((pci_read) != 0) {
  86.             const uint lowestBit  = get_number_of_lowest_set_bit(pci_read);
  87.             const uint highestBit = get_number_of_highest_set_bit(pci_read);
  88.             if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
  89.                 pci_config_writed(addr,barOffset,pci_backup);
  90.                 pci_read=pci_config_readd(addr,barOffset);
  91.                 //kprintf("IO-Ressource\n");
  92.                 uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
  93.                 outl(address1 + offset,val);
  94.             }
  95.         }
  96.     }
  97.     pci_config_writed(addr,barOffset,pci_backup);
  98. }
Advertisement
Add Comment
Please, Sign In to add comment