1 #define __OOP_NOATTRBASES__
3 #include <utility/hooks.h>
4 #include <exec/interrupts.h>
5 #include <aros/macros.h>
10 #include <aros/asmcall.h>
12 #include <proto/oop.h>
14 #include "DriverData.h"
15 #include "pci_wrapper.h"
17 #include <aros/debug.h>
18 #define KPrintF kprintf
20 struct Library
*OOPBase
;
22 static OOP_AttrBase __IHidd_PCIDev
;
23 static OOP_Object
*pciobj
, *irqobj
;
25 static OOP_MethodID mid_RB
;
26 static OOP_MethodID mid_RW
;
27 static OOP_MethodID mid_RL
;
29 static OOP_MethodID mid_WB
;
30 static OOP_MethodID mid_WW
;
31 static OOP_MethodID mid_WL
;
33 static HIDDT_IRQ_Handler inthandler
;
34 static BOOL inthandler_added
;
36 BOOL
ahi_pci_init(struct DriverBase
* AHIsubBase
)
38 OOPBase
= OpenLibrary(AROSOOP_NAME
, 0);
41 __IHidd_PCIDev
= OOP_ObtainAttrBase(IID_Hidd_PCIDevice
);
44 pciobj
= OOP_NewObject(NULL
, CLID_Hidd_PCI
, NULL
);
45 irqobj
= OOP_NewObject(NULL
, CLID_Hidd_IRQ
, NULL
);
49 mid_RB
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_ReadConfigByte
);
50 mid_RW
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_ReadConfigWord
);
51 mid_RL
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_ReadConfigLong
);
53 mid_WB
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_WriteConfigByte
);
54 mid_WW
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_WriteConfigWord
);
55 mid_WL
= OOP_GetMethodID(IID_Hidd_PCIDevice
, moHidd_PCIDevice_WriteConfigLong
);
65 void ahi_pci_exit(void)
68 OOP_DisposeObject(irqobj
);
70 OOP_DisposeObject(pciobj
);
72 OOP_ReleaseAttrBase(IID_Hidd_PCIDevice
);
74 CloseLibrary(OOPBase
);
80 OOP_Object
*found_dev
;
83 static AROS_UFH3(void, Enumerator
,
84 AROS_UFHA(struct Hook
*, hook
, A0
),
85 AROS_UFHA(OOP_Object
*, device
, A2
),
86 AROS_UFHA(APTR
, msg
, A1
))
90 struct enum_data
*ed
= (struct enum_data
*)hook
->h_Data
;
92 if ((ed
->found_dev
== 0) && (device
!= ed
->prev_dev
))
94 ed
->found_dev
= device
;
101 APTR
ahi_pci_find_device(ULONG vendorid
, ULONG deviceid
, APTR dev
)
105 struct Hook FindHook
=
107 h_Entry
: (HOOKFUNC
)Enumerator
,
111 struct TagItem Reqs
[] =
114 { tHidd_PCI_Class
, 0x04 }, /* Multimedia */
115 { tHidd_PCI_SubClass
, 0x01 }, /* Audio */
117 { tHidd_PCI_VendorID
, vendorid
},
118 { tHidd_PCI_ProductID
, deviceid
},
122 struct pHidd_PCI_EnumDevices enummsg
=
124 mID
: OOP_GetMethodID(CLID_Hidd_PCI
, moHidd_PCI_EnumDevices
),
126 requirements
: (struct TagItem
*)&Reqs
,
129 ed
.prev_dev
= (OOP_Object
*)dev
;
132 OOP_DoMethod(pciobj
, (OOP_Msg
)msg
);
134 //KPrintF("ahi_pci_find_device: found_dev = %lx\n", ed.found_dev);
136 return (APTR
)ed
.found_dev
;
139 ULONG
pci_inl(ULONG addr
, struct SB128_DATA
*card
)
141 return LONGIN(card
->iobase
+ addr
);
144 UWORD
pci_inw(ULONG addr
, struct SB128_DATA
*card
)
146 return WORDIN(card
->iobase
+ addr
);
149 UBYTE
pci_inb(ULONG addr
, struct SB128_DATA
*card
)
151 return BYTEIN(card
->iobase
+ addr
);
154 void pci_outl(ULONG value
, ULONG addr
, struct SB128_DATA
*card
)
156 LONGOUT(card
->iobase
+ addr
, value
);
159 void pci_outw(UWORD value
, ULONG addr
, struct SB128_DATA
*card
)
161 WORDOUT(card
->iobase
+ addr
, value
);
164 void pci_outb(UBYTE value
, ULONG addr
, struct SB128_DATA
*card
)
166 BYTEOUT(card
->iobase
+ addr
, value
);
169 void outb_setbits(UBYTE value
, ULONG addr
, struct SB128_DATA
*card
)
171 UBYTE data
= pci_inb(addr
, card
);
174 pci_outb(data
, addr
, card
);
178 void outb_clearbits(UBYTE value
, ULONG addr
, struct SB128_DATA
*card
)
180 UBYTE data
= pci_inb(addr
, card
);
183 pci_outb(data
, addr
, card
);
187 void outw_setbits(UWORD value
, ULONG addr
, struct SB128_DATA
*card
)
189 UWORD data
= pci_inw(addr
, card
);
192 pci_outw(data
, addr
, card
);
196 void outw_clearbits(UWORD value
, ULONG addr
, struct SB128_DATA
*card
)
198 UWORD data
= pci_inw(addr
, card
);
201 pci_outw(data
, addr
, card
);
205 void outl_setbits(ULONG value
, ULONG addr
, struct SB128_DATA
*card
)
207 ULONG data
= pci_inl(addr
, card
);
210 pci_outl(data
, addr
, card
);
214 void outl_clearbits(ULONG value
, ULONG addr
, struct SB128_DATA
*card
)
216 ULONG data
= pci_inl(addr
, card
);
219 pci_outl(data
, addr
, card
);
223 ULONG
inl_config(UBYTE reg
, APTR dev
)
225 struct pHidd_PCIDevice_ReadConfigLong msg
;
230 return OOP_DoMethod((OOP_Object
*)dev
, (OOP_Msg
)&msg
);
233 UWORD
inw_config(UBYTE reg
, APTR dev
)
235 struct pHidd_PCIDevice_ReadConfigWord msg
;
240 return OOP_DoMethod((OOP_Object
*)dev
, (OOP_Msg
)&msg
);
243 UBYTE
inb_config(UBYTE reg
, APTR dev
)
245 struct pHidd_PCIDevice_ReadConfigByte msg
;
250 return OOP_DoMethod(dev
, (OOP_Msg
)&msg
);
253 void outl_config(UBYTE reg
, ULONG val
, APTR dev
)
255 struct pHidd_PCIDevice_WriteConfigLong msg
;
261 OOP_DoMethod((OOP_Object
*)dev
, (OOP_Msg
)&msg
);
264 void outw_config(UBYTE reg
, UWORD val
, APTR dev
)
266 struct pHidd_PCIDevice_WriteConfigWord msg
;
272 OOP_DoMethod((OOP_Object
*)dev
, (OOP_Msg
)&msg
);
275 void outb_config(UBYTE reg
, UBYTE val
, APTR dev
)
277 struct pHidd_PCIDevice_WriteConfigByte msg
;
283 OOP_DoMethod((OOP_Object
*)dev
, (OOP_Msg
)&msg
);
286 ULONG
ahi_pci_get_irq(APTR dev
)
290 OOP_GetAttr((OOP_Object
*)dev
, aHidd_PCIDevice_INTLine
, &val
);
295 static void interrupt_code(HIDDT_IRQ_Handler
*irq
, HIDDT_IRQ_HwInfo
*hw
)
297 struct Interrupt
*i
= (struct Interrupt
*)irq
->h_Data
;
299 AROS_UFC3(void, i
->is_Code
,
300 AROS_UFCA(APTR
, i
->is_Data
, A1
),
301 AROS_UFCA(APTR
, i
->is_Code
, A5
),
302 AROS_UFCA(struct ExecBase
*, SysBase
, A6
));
306 BOOL
ahi_pci_add_intserver(struct Interrupt
*i
, APTR dev
)
308 struct pHidd_IRQ_AddHandler __msg__
, *msg
= &__msg__
;
311 OOP_GetAttr((OOP_Object
*)dev
, aHidd_PCIDevice_INTLine
, &val
);
313 inthandler
.h_Node
.ln_Pri
= 1;
314 inthandler
.h_Node
.ln_Name
= "SB128 IRQ";
315 inthandler
.h_Code
= interrupt_code
;
316 inthandler
.h_Data
= i
;
318 msg
->mID
= OOP_GetMethodID(CLID_Hidd_IRQ
, moHidd_IRQ_AddHandler
);
319 msg
->handlerinfo
= &inthandler
;
322 OOP_DoMethod(irqobj
, (OOP_Msg
)msg
);
324 inthandler_added
= TRUE
;
329 void ahi_pci_rem_intserver(struct Interrupt
*i
, APTR dev
)
331 if (inthandler_added
)
333 struct pHidd_IRQ_RemHandler __msg__
=
335 mID
: OOP_GetMethodID(CLID_Hidd_IRQ
, moHidd_IRQ_RemHandler
),
336 handlerinfo
: &inthandler
,
339 OOP_DoMethod(irqobj
, (OOP_Msg
)msg
);
341 inthandler_added
= FALSE
;
344 KPrintF("ahi_pci_rem_intserver\n");
348 APTR
ahi_pci_get_base_address(WORD which
, APTR dev
)
356 attr
= aHidd_PCIDevice_Base0
;
360 attr
= aHidd_PCIDevice_Base1
;
364 attr
= aHidd_PCIDevice_Base2
;
368 attr
= aHidd_PCIDevice_Base3
;
372 attr
= aHidd_PCIDevice_Base4
;
376 attr
= aHidd_PCIDevice_Base5
;
383 OOP_GetAttr((OOP_Object
*)dev
, attr
, &val
);
385 //KPrintF("ahi_pci_get_base_address. Result %lx\n", val);
390 ULONG
ahi_pci_get_base_size(WORD which
, APTR dev
)
398 attr
= aHidd_PCIDevice_Size0
;
402 attr
= aHidd_PCIDevice_Size1
;
406 attr
= aHidd_PCIDevice_Size2
;
410 attr
= aHidd_PCIDevice_Size3
;
414 attr
= aHidd_PCIDevice_Size4
;
418 attr
= aHidd_PCIDevice_Size5
;
425 OOP_GetAttr((OOP_Object
*)dev
, attr
, &val
);
427 //KPrintF("ahi_pci_get_base_size. Result %lx\n", val);
435 ULONG
ahi_pci_get_type(WORD which
, APTR dev
)
443 attr
= aHidd_PCIDevice_Type0
;
447 attr
= aHidd_PCIDevice_Type1
;
451 attr
= aHidd_PCIDevice_Type2
;
455 attr
= aHidd_PCIDevice_Type3
;
459 attr
= aHidd_PCIDevice_Type4
;
463 attr
= aHidd_PCIDevice_Type5
;
470 OOP_GetAttr((OOP_Object
*)dev
, attr
, &val
);
472 //KPrintF("ahi_pci_get_type. Result %lx\n", val);