Subversion Repositories Kolibri OS

Rev

Blame | Last modification | View Log | Download | RSS feed

  1.                 ;;      rs780 PCIe config space test
  2.                 ;;      (C) art_zh 2010
  3.                 ;;      <kolibri@jerdev.co.uk>
  4.  
  5.  
  6.   use32              ;
  7.   org    0x0         ;
  8.  
  9.   db     'MENUET01'  ;
  10.   dd     0x01        ;
  11.   dd     START       ;
  12.   dd     I_END       ;
  13.   dd     0x1000      ;
  14.   dd     0x1000      ;
  15.   dd     0x0         ;
  16.   dd     0x0         ;
  17.  
  18. include 'MACROS.INC' ;
  19.  
  20. PCIE_SPACE      equ     0xF0000000
  21. ;PCIE_ADDR       equ     0xF0008000   ; bdf0:1.0  = internal GFX P2P bridge
  22. PCIE_ADDR       equ     0xF0010000    ; bdf0:2.0  = PCIE P2P bridge
  23. BOX_COLOR       equ     0xE0D8D0
  24.  
  25. START:
  26.  
  27.  
  28.  
  29.  
  30.  
  31. red:
  32.  
  33.     call draw_window
  34.  
  35. still:
  36.     mcall 10            ; event waiting
  37.  
  38.     cmp  eax,1          ; redraw window
  39.     je   red            ;
  40.     cmp  eax,2          ; key pressed?
  41.     je   key            ;
  42.     cmp  eax,3          ; button hit?
  43.     je   button         ;
  44.  
  45.     jmp  still          ; none of that
  46.  
  47. ;---------------------------------------------------------------------
  48.  
  49.  key:                  ; key pressed
  50.    jmp    red
  51.  
  52. ;---------------------------------------------------------------------
  53.  
  54.   button:
  55.     mcall 17            ; get the button ID
  56.     cmp   ah, 1
  57.     jne   .bt2
  58.     mcall -1
  59. .bt2:
  60.         cmp     ah, 2
  61.         jne     .bt3
  62.         sub     [Reg],4   ; Rg# decrement
  63.         jmp     red
  64. .bt3:
  65.         cmp     ah, 3
  66.         jne     .bt4
  67.         add     [Reg],4   ; Rg# increment
  68.         jmp     red
  69. .bt4:
  70.         cmp     ah, 4
  71.         jne     .bt5
  72.         add     [Reg],4*16      ; PgDn
  73.         jmp     red
  74. .bt5:
  75.         cmp     ah, 5
  76.         jne     .bt6
  77.         mov     edx, [Reg]
  78.         cmp     edx, 4*16
  79.         jb      @f
  80.         sub     edx, 4*16
  81.         mov     [Reg],edx      ; PgUp
  82.         jmp     red
  83. @@:
  84.         xor     edx, edx
  85.         mov     [Reg], edx
  86.         jmp     red
  87.  
  88. .bt6:
  89.         cmp     ah, 6
  90.         jne     still
  91.         mcall   37, 1           ; get the mouse pointer
  92.         shr     eax, 16         ; only X needed
  93.         sub     eax, 124        ; check the left border
  94.         jb      red
  95.         xor     edx, edx
  96.         mov     ebx, 12
  97.         div     ebx
  98.         cmp     eax, 32         ; check the right border
  99.         jnb     red
  100.         mov     ecx, 31
  101.         sub     ecx, eax         ; reverse the bit order
  102.         mov     ebx, [Rct]
  103.         btc     ebx, ecx        ; invert the bit
  104.         mov     eax, [Reg]
  105.         add     eax, PCIE_ADDR
  106.         mov     [Rct], ebx
  107.         mov     [eax], ebx
  108.  
  109.     jmp   red
  110.  
  111.  
  112. ;------------------------------------------------
  113. print_config_reg:
  114. ;------------------------------------------------
  115.         mov     eax, [reg]
  116.         and     eax, 0x0FFC
  117.         mov     ebx, 4*65536+256   ; 4 hex digits
  118.         mov     ecx, eax
  119.         mov     dx,[stX]
  120.         shl     edx,16             ; = X*65536
  121.         mov     dx,[stY]           ; = edx + Y
  122.         mov     esi,0
  123.         mcall 47                   ; print reg#
  124.         mov     eax, [reg]
  125.         add     eax, PCIE_ADDR
  126.         mov     ecx, [eax]
  127.         add     edx, 36*65536      ; right column
  128.         mov     ebx, 8*65536+256   ; 8 hex digits
  129.         mcall 47                   ; print config data
  130.         ret
  131. ;------------------------------------------------
  132. read_nbconfig:
  133. ; in:  dl = reg#  |  out: eax = data
  134. ;------------------------------------------------
  135.         mov     ebx, 0xF0000000
  136.         and     edx, 0x0FC
  137.         mov     eax, dword [ebx+edx]
  138.         ret
  139. ;------------------------------------------------
  140. write_nbconfig:
  141. ; in: dl = reg#; eax = data
  142. ;------------------------------------------------
  143.         mov     ebx, 0xF0000000
  144.         and     edx, 0x0FC
  145.         mov     dword [ebx+edx], eax
  146.         ret
  147.  
  148. ;------------------------------------------------
  149. ;read_htiunbind:
  150. ; in:  [HTr] = reg#  |  out: eax = data
  151. ;------------------------------------------------
  152. ;        mov     dl,  0x94
  153. ;        mov     al,  byte[HTr]
  154. ;        and     eax, 0x07C
  155. ;        call    write_nbconfig
  156. ;        add     dl,  4
  157. ;        call    read_nbconfig
  158. ;        ret
  159. ;------------------------------------------------
  160. ;write_htiunbind:
  161. ; in:  [HTr] = reg#; ecx = data
  162. ;------------------------------------------------
  163. ;        mov     dl,  0x94
  164. ;        mov     al,  byte[Reg]
  165. ;        and     eax, 0x017C
  166. ;        call    write_nbconfig
  167. ;        add     dl,  4
  168. ;        mov     ecx, eax
  169. ;        call    write_nbconfig
  170. ;        sub     dl,  4
  171. ;        mov     eax, 0x0
  172. ;        call    write_nbconfig
  173. ;        ret
  174.  
  175.  
  176.  
  177.  
  178.  
  179.  
  180.  
  181. ;------------------------------------------------
  182.     draw_window:
  183. ;------------------------------------------------
  184.  
  185.  
  186.     mcall 12, 1
  187.     mcall 0, 600*65536+530, 120*65536+290, 0x1499AABB,,title
  188. ; -----------------------------------------------------------------
  189. ; BUTTONS:   Xleft    Xwid,  Ytop    Yheig
  190.     mcall 8, 370*65536+ 40,  26*65536+ 18, 2, 0x99AABB ;  <<
  191.     mcall  ,              ,  51*65536+ 18, 3,          ;  >>
  192.     mcall  , 425*65536+ 90,  26*65536+ 18, 4,          ; PCIe Cfg
  193.     mcall  ,              ,  51*65536+ 18, 5,          ; NB config
  194.     mcall  , 117*65536+400,  97*65536+ 40, 6,          ; Bits
  195.  
  196.         mov     edx, [Reg]
  197.         add     edx, PCIE_ADDR          ; reading the current reg content
  198.         mov     ecx, [edx]
  199.         mov     [Rct], ecx
  200.  
  201.         mov     ebx, bitstr2
  202.         inc     ebx
  203.         mov     edx, [Rct]
  204.         mov     ecx, 0x80000000
  205.         xor     eax, eax
  206. .stringtest:
  207.         test    edx, ecx
  208.         jz      @f
  209.         mov     byte [ebx+eax*2],'I'    ; bit dump
  210.         jmp     .nextbit
  211. @@:
  212.         mov     byte [ebx+eax*2],'0'
  213. .nextbit:
  214.         inc     eax
  215.         shr     ecx, 1
  216.         jnz     .stringtest
  217.  
  218. ; button txt:  X *65536+ Y
  219.     mcall  4, 378*65536+32 ,0x10000000, butstr2,3
  220.     mcall  ,  378*65536+57 ,          , butstr3,
  221.     mcall  ,  436*65536+32 ,          , butstr4,9
  222.     mcall  ,  436*65536+57 ,          , butstr5,
  223.  
  224.     mcall  4, 122*65536+101,0          , bitstr0,65
  225.     mcall  ,  122*65536+110,0          , bitstr1,65
  226.     mcall  ,  122*65536+117,0          , bitstr2,65
  227.     mcall  ,  122*65536+126,0          , bitstr3,65
  228. ; -----------------------------------------------------------------
  229. ;    draw the reg-value box
  230.         mov     ebx, 10*65536+100       ; Xleft | Xwidth
  231.         mov     ecx, 26*65536+250       ; Ytop  | Yheight
  232.         mov     edx, BOX_COLOR
  233.         mcall   13
  234. ;    draw the reg-address box
  235.         mov     ebx, 206*65536+146      ; Xleft | Xwidth
  236.         mov     cx, 44                  ; Yheight only
  237.         mcall   13
  238. ;    draw ZiS status box
  239. ;        mov     ebx, 206*65536+274      ; Xleft | Xwidth
  240. ;        mov     ecx,  84*65536+ 64      ; Ytop  | Yheight
  241. ;        mcall   13
  242. ;    draw the dump box
  243. ;        mov     ebx, 206*65536+274      ; Xleft | Xwidth
  244. ;        mov     ecx, 190*65536+232      ; Ytop  | Yheight
  245. ;        mcall   13
  246.  
  247. ;    fill the data box
  248.         mov     ebx, [Reg]
  249.         mov     [reg],ebx
  250.         mov     bx, 40         ; upper position
  251.         mov     [stY],bx
  252. .print_reg_names:
  253.         call    print_config_reg
  254.         add     [stY],14
  255.         add     [reg], 4
  256.         mov     edx,[Reg]
  257.         add     edx,16*4
  258.         cmp     edx,[reg]
  259.         ja      .print_reg_names
  260.  
  261. ;   fill the status box
  262.         mcall   4, 210*65536+30,0,str1,12
  263.         mcall   ,  210*65536+44, ,str2,
  264.         mcall   ,  210*65536+56, ,str3,
  265.         mov     ecx, PCIE_ADDR
  266.         mov     edx, 300*65536+30
  267.         mov     ebx, 8*65536+256
  268.         mcall   47
  269.         add     dx, 14
  270.         mov     ecx,[Reg]
  271.         mov     esi, 0
  272.         mcall   47
  273.         add     dx,14
  274.         mov     ecx, [Rct]
  275.         mcall   47
  276.  
  277. ;    print extra info
  278.         mov     ebx, 120*65536+180
  279.         xor     ecx, ecx
  280.         mov     edx, info1
  281. @@:
  282.         mcall   4,,,,66
  283.         add     edx, 66
  284.         add     ebx, 14
  285.         cmp     edx, info_end
  286.         jb      @b
  287.  
  288.  
  289.     mcall 12, 2                    
  290.  
  291. ret
  292.  
  293.  
  294. align 4
  295. ;-------------------------------------------------
  296.  
  297.   pix   dd  0x55AACC33
  298.   pxX   dd  200
  299.   pxY   dd  160
  300.   stX   dw  18
  301.   stY   dw  0
  302.   reg   dd  0
  303.  
  304.   Rct   dd  0        ; reg content
  305.   Reg   dd  0x00     ; reg number
  306.  
  307.  
  308.  title db '          RS780 PCIe registers ',0
  309. ;------------------------------------------------------------------------------------
  310.  reg_str   db   'Reg#| hex.Value  '
  311. ;------------------------------------------------------------------------------------
  312. str1    db      'bdf address:'
  313. str2    db      'Reg. number:'
  314. str3    db      'Reg.content:'
  315.  
  316.  butstr2 db ' << '
  317.  butstr3 db ' >> '
  318.  butstr4 db 'Next Page'
  319.  butstr5 db 'Prev Page'
  320.  
  321. bitstr0  db     '31',209,205,209,205,209,205,209,205,209,205,209,205,'24',\
  322.                 209,205,209,205,209,205,209,205,209,205,209,205,209,205,'16',\
  323.                 209,'15',205,209,205,209,205,209,205,209,205,209,205,209,'8',\
  324.                 205,'7',209,205,209,205,209,205,209,205,209,205,209,205,209,'0',184
  325. bitstr1  db     179,' | | | | | | | | | | | | | | | | | | | | | | | | | | | | | | | ',179
  326. bitstr2  db     179,'1 0 9 8',179,'7 6 5 4',179,'3 2 1 0',179,'9 8 7 6',\
  327.                 179,'5 4 3 2',179,'1 0 9 8',179,'7 6 5 4',179,'3 2 1 0',179
  328. bitstr3  db     212,205,207,205,207,205,207,205,207,205,207,205,207,205,207,205,207,\
  329.                 205,207,205,207,205,207,205,207,205,207,205,207,205,207,205,207,205,207,\
  330.                 205,207,205,207,205,207,205,207,205,207,205,207,205,207,205,207,205,207,\
  331.                 205,207,205,207,205,207,205,207,205,207,205,190
  332.  
  333. info1   db      '--------------------------- extra info ---------------------------'
  334. info2   db      '| reg 00[31:16] (DeviceID): 9602=int. GFX;  9603=PCIE GFX bridge |'
  335.         db      '| reg                                                            |'
  336.         db      '| reg                                                            |'
  337.         db      '| reg                                                            |'
  338.         db      '------------------------------------------------------------------'
  339. info_end:
  340.  
  341. I_END:          ; end of program
  342.  
  343.         rd 256
  344.  
  345. align 256
  346. st_0:
  347.