Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- uint8_t pci_read_register(pci_bdf_t addr, uint32_t barOffset, uint32_t offset) {
- uint8_t res;
- barOffset=(0x010+(barOffset*4));
- uint32_t pci_read=pci_config_readd(addr,barOffset);
- uint32_t pci_backup=pci_config_readd(addr,barOffset);
- if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
- pci_config_writed(addr,barOffset,0xFFFFFFF0);
- pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
- const uint lowestBit = get_number_of_lowest_set_bit(pci_read);
- if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
- pci_config_writed(addr,barOffset,pci_backup);
- pci_read=pci_config_readd(addr,barOffset);
- //kprintf("32-Bit-Memory-Ressource\n");
- uint8_t *address=(uint8_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
- kprintf("Offset 0x%x: %b - 0x%x\n",offset,address[offset],address[offset]);
- res=address[offset];
- }
- } else { //IO-Ressource
- pci_config_writed(addr,barOffset,0xFFFFFFFC);
- pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
- if((pci_read) != 0) {
- const uint lowestBit = get_number_of_lowest_set_bit(pci_read);
- const uint highestBit = get_number_of_highest_set_bit(pci_read);
- if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
- pci_config_writed(addr,barOffset,pci_backup);
- pci_read=pci_config_readd(addr,barOffset);
- //kprintf("IO-Ressource\n");
- uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
- kprintf("Offset 0x%x: %b - 0x%x\n",offset,inb(address1 + offset),inb(address1 + offset));
- res=inb(address1 + offset);
- }
- }
- }
- pci_config_writed(addr,barOffset,pci_backup);
- return res;
- }
- void pci_write_register(pci_bdf_t addr, uint32_t barOffset, uint32_t offset, uint8_t val) {
- barOffset=(0x010+(barOffset*4));
- uint32_t pci_read=pci_config_readd(addr,barOffset);
- uint32_t pci_backup=pci_config_readd(addr,barOffset);
- if((pci_read & 0x1) == 0 && (pci_read >> 1 & 0x3) == 0) { //32-Bit-Memory-Ressource
- pci_config_writed(addr,barOffset,0xFFFFFFF0);
- pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFF0;
- const uint lowestBit = get_number_of_lowest_set_bit(pci_read);
- if(pci_read!=0 && !( (get_number_of_highest_set_bit(pci_read) != 31) || (lowestBit > 31) || (lowestBit < 4) )) {
- pci_config_writed(addr,barOffset,pci_backup);
- pci_read=pci_config_readd(addr,barOffset);
- //kprintf("32-Bit-Memory-Ressource\n");
- uint8_t *address=(uint8_t*)((uint32_t)(pci_read & 0xFFFFFFF0));
- address[offset]=val;
- }
- } else { //IO-Ressource
- pci_config_writed(addr,barOffset,0xFFFFFFFC);
- pci_read=pci_config_readd(addr,barOffset) & 0xFFFFFFFC;
- if((pci_read) != 0) {
- const uint lowestBit = get_number_of_lowest_set_bit(pci_read);
- const uint highestBit = get_number_of_highest_set_bit(pci_read);
- if (!( ( (highestBit != 31) && (highestBit != 15) ) || (highestBit < lowestBit) || (lowestBit < 2) )) {
- pci_config_writed(addr,barOffset,pci_backup);
- pci_read=pci_config_readd(addr,barOffset);
- //kprintf("IO-Ressource\n");
- uint32_t address1=(uint32_t)(pci_read & 0xFFFFFFFC);
- outb(address1 + offset,val);
- }
- }
- }
- pci_config_writed(addr,barOffset,pci_backup);
- }
Advertisement
Add Comment
Please, Sign In to add comment