git@UCC - tpg/acess2.git/blob - Kernel/arch/x86/pci.c

1 /*\r

2 * Acess2\r

3 * arch/x86/pci.h - x86 PCI Bus Access\r

4 */\r

5 #define DEBUG 0\r

6 #include <acess.h>\r

7 \r

8 // === PROTOTYPES ===\r

9 Uint32 PCI_CfgReadDWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset);\r

10 void PCI_CfgWriteDWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset, Uint32 data);\r

11 Uint16 PCI_CfgReadWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset);\r

12 Uint8 PCI_CfgReadByte(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset);\r

13 \r

14 // === CODE ===\r

15 Uint32 PCI_CfgReadDWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset)\r

16 {\r

17 Uint32 address;\r

18 Uint32 data;\r

19 \r

20 bus &= 0xFF; // 8 Bits\r

21 dev &= 0x1F; // 5 Bits\r

22 func &= 0x7; // 3 Bits\r

23 offset &= 0xFF; // 8 Bits\r

24 \r

25 address = 0x80000000 | ((Uint)bus<<16) | ((Uint)dev<<11) | ((Uint)func<<8) | (offset&0xFC);\r

26 outd(0xCF8, address);\r

27 \r

28 data = ind(0xCFC);\r

29 //Debug("PCI(0x%x) = 0x%08x", address, data);\r

30 return data;\r

31 }\r

32 void PCI_CfgWriteDWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset, Uint32 data)\r

33 {\r

34 Uint32 address;\r

35 \r

36 bus &= 0xFF; // 8 Bits\r

37 dev &= 0x1F; // 5 Bits\r

38 func &= 0x7; // 3 Bits\r

39 offset &= 0xFF; // 8 Bits\r

40 \r

41 address = 0x80000000 | ((Uint)bus<<16) | ((Uint)dev<<11) | ((Uint)func<<8) | (offset&0xFC);\r

42 outd(0xCF8, address);\r

43 outd(0xCFC, data);\r

44 }\r

45 Uint16 PCI_CfgReadWord(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset)\r

46 {\r

47 Uint32 data = PCI_CfgReadDWord(bus, dev, func, offset);\r

48 \r

49 data >>= (offset&2)*8; // Allow Access to Upper Word\r

50 \r

51 return (Uint16)data;\r

52 }\r

53 \r

54 Uint8 PCI_CfgReadByte(Uint16 bus, Uint16 dev, Uint16 func, Uint16 offset)\r

55 {\r

56 Uint32 data = PCI_CfgReadDWord(bus, dev, func, offset);\r

57 \r

58 data >>= (offset&3)*8; //Allow Access to Upper Word\r

59 return (Uint8)data;\r

60 }\r

61 \r