196 lines
6.6 KiB
Forth
196 lines
6.6 KiB
Forth
|
\ *****************************************************************************
|
||
|
|
\ * Copyright (c) 2004, 2011 IBM Corporation
|
||
|
|
\ * All rights reserved.
|
||
|
|
\ * This program and the accompanying materials
|
||
|
|
\ * are made available under the terms of the BSD License
|
||
|
|
\ * which accompanies this distribution, and is available at
|
||
|
|
\ * http://www.opensource.org/licenses/bsd-license.php
|
||
|
|
\ *
|
||
|
|
\ * Contributors:
|
||
|
|
\ * IBM Corporation - initial implementation
|
||
|
|
\ ****************************************************************************/
|
||
|
|
|
||
|
|
\ ----------------------------------------------------------
|
||
|
|
\ **************** PCI Helper functions *******************
|
||
|
|
\ ----------------------------------------------------------
|
||
|
|
|
||
|
|
\ convert an integer to string of len digits
|
||
|
|
: int2str ( int len -- str len ) swap s>d rot <# 0 ?DO # LOOP #> ;
|
||
|
|
|
||
|
|
\ convert addr to busnr
|
||
|
|
: pci-addr2bus ( addr -- busnr ) 10 rshift FF and ;
|
||
|
|
|
||
|
|
\ convert addr to devnr
|
||
|
|
: pci-addr2dev ( addr -- dev ) B rshift 1F and ;
|
||
|
|
|
||
|
|
\ convert addr to functionnumber
|
||
|
|
: pci-addr2fn ( addr -- dev ) 8 rshift 7 and ;
|
||
|
|
|
||
|
|
\ convert busnr devnr to addr
|
||
|
|
: pci-bus2addr ( busnr devnr -- addr ) B lshift swap 10 lshift + ;
|
||
|
|
|
||
|
|
\ print out a pci config addr
|
||
|
|
: pci-addr-out ( addr -- ) dup pci-addr2bus 2 0.r space FFFF and 4 0.r ;
|
||
|
|
|
||
|
|
\ Dump out the whole configspace
|
||
|
|
: pci-dump ( addr -- )
|
||
|
|
10 0 DO
|
||
|
|
dup
|
||
|
|
cr i 4 * +
|
||
|
|
dup pci-addr-out space
|
||
|
|
rtas-config-l@ 8 0.r
|
||
|
|
LOOP
|
||
|
|
drop cr
|
||
|
|
;
|
||
|
|
|
||
|
|
|
||
|
|
\ ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
||
|
|
\ the following functions use l@ to fetch the data,
|
||
|
|
\ that's because the some pcie cores have probs with w@
|
||
|
|
\ ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
||
|
|
|
||
|
|
\ read Vendor ID
|
||
|
|
: pci-vendor@ ( addr -- id ) rtas-config-l@ FFFF and ;
|
||
|
|
|
||
|
|
\ read Device ID
|
||
|
|
: pci-device@ ( addr -- id ) rtas-config-l@ 10 rshift ;
|
||
|
|
|
||
|
|
\ read Status
|
||
|
|
: pci-status@ ( addr -- status ) 4 + rtas-config-l@ 10 rshift ;
|
||
|
|
|
||
|
|
\ read Revision ID
|
||
|
|
: pci-revision@ ( addr -- id ) 8 + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ read Class Code
|
||
|
|
: pci-class@ ( addr -- class ) 8 + rtas-config-l@ 8 rshift ;
|
||
|
|
|
||
|
|
\ read Cache Line Size
|
||
|
|
: pci-cache@ ( addr -- size ) C + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ read Header Type
|
||
|
|
: pci-htype@ ( addr -- type ) E + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ read Sub Vendor ID
|
||
|
|
: pci-sub-vendor@ ( addr -- sub-id ) 2C + rtas-config-l@ FFFF and ;
|
||
|
|
|
||
|
|
\ read Sub Device ID
|
||
|
|
: pci-sub-device@ ( addr -- sub-id ) 2C + rtas-config-l@ 10 rshift FFFF and ;
|
||
|
|
|
||
|
|
\ read Interrupt Pin
|
||
|
|
: pci-interrupt@ ( addr -- interrupt ) 3D + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ read Minimum Grant
|
||
|
|
: pci-min-grant@ ( addr -- min-gnt ) 3E + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ read Maximum Latency
|
||
|
|
: pci-max-lat@ ( addr -- max-lat ) 3F + rtas-config-b@ ;
|
||
|
|
|
||
|
|
\ Check if Capabilities are valid
|
||
|
|
: pci-capabilities? ( addr -- 0|1 ) pci-status@ 4 rshift 1 and ;
|
||
|
|
|
||
|
|
\ fetch the offset of the next capability
|
||
|
|
: pci-cap-next ( cap-addr -- next-cap-off ) rtas-config-b@ FC and ;
|
||
|
|
|
||
|
|
\ calc the address of the next capability
|
||
|
|
: pci-cap-next-addr ( cap-addr -- next-cap-addr ) 1+ dup pci-cap-next dup IF swap -100 and + ELSE nip THEN ;
|
||
|
|
|
||
|
|
|
||
|
|
\ Dump out all capabilities
|
||
|
|
: pci-cap-dump ( addr -- )
|
||
|
|
cr
|
||
|
|
dup pci-capabilities? IF
|
||
|
|
33 + BEGIN
|
||
|
|
pci-cap-next-addr dup 0<>
|
||
|
|
WHILE
|
||
|
|
dup pci-addr-out s" : " type
|
||
|
|
dup rtas-config-b@ 2 0.r cr
|
||
|
|
REPEAT
|
||
|
|
s" end found "
|
||
|
|
ELSE
|
||
|
|
s" capabilities not enabled!"
|
||
|
|
THEN
|
||
|
|
type cr drop
|
||
|
|
;
|
||
|
|
|
||
|
|
\ search the capability-list for this id
|
||
|
|
: pci-cap-find ( addr id -- capp-addr|0 )
|
||
|
|
swap dup pci-capabilities? IF
|
||
|
|
33 + BEGIN
|
||
|
|
pci-cap-next-addr dup 0<> IF
|
||
|
|
dup rtas-config-b@ 2 pick =
|
||
|
|
ELSE
|
||
|
|
true
|
||
|
|
THEN
|
||
|
|
UNTIL
|
||
|
|
nip
|
||
|
|
ELSE
|
||
|
|
2drop 0
|
||
|
|
THEN
|
||
|
|
;
|
||
|
|
|
||
|
|
\ check wether this device is a pci-express device
|
||
|
|
: pci-express? ( addr -- 0|1 ) 10 pci-cap-find 0<> ;
|
||
|
|
|
||
|
|
\ check wether this device is a pci-express device
|
||
|
|
: pci-x? ( addr -- 0|1 ) 07 pci-cap-find 0<> ;
|
||
|
|
|
||
|
|
\ check wether this device has extended config space
|
||
|
|
: pci-config-ext? ( addr -- 0|1 ) pci-express? ;
|
||
|
|
|
||
|
|
|
||
|
|
\ Disable Bus Master, Memory Space and I/O Space for this device
|
||
|
|
: pci-device-disable ( -- ) my-space 4 + dup rtas-config-l@ 7 invert and swap rtas-config-l! ;
|
||
|
|
|
||
|
|
\ Enable Bus Master
|
||
|
|
: pci-master-enable ( -- ) my-space 4 + dup rtas-config-l@ 4 or swap rtas-config-l! ;
|
||
|
|
|
||
|
|
\ Disable Bus Master
|
||
|
|
: pci-master-disable ( -- ) my-space 4 + dup rtas-config-l@ 4 invert and swap rtas-config-l! ;
|
||
|
|
|
||
|
|
\ Enable response to mem accesses of pci device
|
||
|
|
: pci-mem-enable ( -- ) my-space 4 + dup rtas-config-w@ 2 or swap rtas-config-w! ;
|
||
|
|
|
||
|
|
\ Enable response to I/O accesses of pci-device
|
||
|
|
: pci-io-enable ( -- ) my-space 4 + dup rtas-config-w@ 1 or swap rtas-config-w! ;
|
||
|
|
|
||
|
|
\ Enable Bus Master, I/O and mem access
|
||
|
|
: pci-enable ( -- ) my-space 4 + dup rtas-config-w@ 7 or swap rtas-config-w! ;
|
||
|
|
|
||
|
|
\ Enable #PERR and #SERR errors of pci-device
|
||
|
|
: pci-error-enable ( -- ) my-space 4 + dup rtas-config-w@ 140 or swap rtas-config-w! ;
|
||
|
|
|
||
|
|
\ prints out the ScanInformation about a device
|
||
|
|
\ char is a sign for device type e.g. D - device ; B - bridge
|
||
|
|
: pci-out ( addr char -- )
|
||
|
|
15 spaces
|
||
|
|
over pci-addr-out
|
||
|
|
s" (" type emit s" ) : " type
|
||
|
|
dup pci-vendor@ 4 0.r space
|
||
|
|
pci-device@ 4 0.r
|
||
|
|
4 spaces
|
||
|
|
;
|
||
|
|
|
||
|
|
|
||
|
|
\ set and fetch the interrupt Pin
|
||
|
|
: pci-irq-line@ ( addr -- irq-pin ) 3C + rtas-config-b@ ;
|
||
|
|
: pci-irq-line! ( pin addr -- ) 3C + rtas-config-b! ;
|
||
|
|
|
||
|
|
\ set and fetch primary bus number
|
||
|
|
: pci-bus-prim! ( nr addr -- ) 18 + dup rtas-config-l@ FFFFFF00 and rot + swap rtas-config-l! ;
|
||
|
|
: pci-bus-prim@ ( addr -- nr ) 18 + rtas-config-l@ FF and ;
|
||
|
|
|
||
|
|
\ set and fetch secondary bus number
|
||
|
|
: pci-bus-scnd! ( nr addr -- ) 18 + dup rtas-config-l@ FFFF00FF and rot 8 lshift + swap rtas-config-l! ;
|
||
|
|
: pci-bus-scnd@ ( addr -- nr ) 18 + rtas-config-l@ 8 rshift FF and ;
|
||
|
|
|
||
|
|
\ set and fetch subordinate bus number
|
||
|
|
: pci-bus-subo! ( nr addr -- ) 18 + dup rtas-config-l@ FF00FFFF and rot 10 lshift + swap rtas-config-l! ;
|
||
|
|
: pci-bus-subo@ ( addr -- nr ) 18 + rtas-config-l@ 10 rshift FF and ;
|
||
|
|
|
||
|
|
\ set and fetch primary, secondary and subordinate bus number
|
||
|
|
: pci-bus! ( subo scnd prim addr -- ) swap rot 8 lshift + rot 10 lshift + swap 18 + dup rtas-config-l@ FF000000 and rot + swap rtas-config-l! ;
|
||
|
|
: pci-bus@ ( addr -- subo scnd prim ) 18 + rtas-config-l@ dup 10 rshift FF and swap dup 8 rshift FF and swap FF and ;
|
||
|
|
|
||
|
|
\ Reset secondary Status
|
||
|
|
: pci-reset-2nd ( addr -- ) 1C + dup rtas-config-l@ FFFF0000 or swap rtas-config-l! ;
|