[openfirmware] r1494 - cpu/ppc ofw/termemu
svn at openfirmware.info
svn at openfirmware.info
Fri Nov 20 22:01:27 CET 2009
Author: wmb
Date: 2009-11-20 22:01:27 +0100 (Fri, 20 Nov 2009)
New Revision: 1494
Modified:
cpu/ppc/fb8-ops.fth
cpu/ppc/kerncode.fth
ofw/termemu/fb8.fth
Log:
PowerPC - added PPC versions of new display primitives.
Modified: cpu/ppc/fb8-ops.fth
===================================================================
--- cpu/ppc/fb8-ops.fth 2009-11-19 17:19:33 UTC (rev 1493)
+++ cpu/ppc/fb8-ops.fth 2009-11-20 21:01:27 UTC (rev 1494)
@@ -43,6 +43,84 @@
addi sp,sp,1cell
c;
+\ Invert foreground and background colors within a rectangular region
+code fb16-invert ( adr width height bytes/line fg-color bg-color -- )
+ \ bg-color in tos
+ lwz t4,0(sp) \ fg-color in t4
+ lwzu t0,1cell(sp) \ bytes/line in scr
+ lwzu t2,1cell(sp) \ height in t1 (outer loop index, >0)
+ lwzu t1,1cell(sp) \ width in t2 (inner loop index, >0)
+ lwzu t3,1cell(sp) \ adr in sc3 (starting address)
+
+ mfspr t6,ctr \ Save counter
+
+ subf t0,t1,t0 \ Account for inner loop incrementing
+ addi t3,t3,-2 \ Account for inner loop incrementing
+
+ begin \ Outer loop
+ mtspr ctr,t1 \ Starting width value
+ begin \ Inner loop
+ lhzu t5,2(t3) \ read halfword
+ cmp 0,0,t5,tos \ Background?
+ = if
+ mr t5,t4 \ Set to foreground
+ else
+ cmp 0,0,t5,t4 \ Foreground?
+ = if
+ mr t5,tos \ Set to background
+ then
+ then
+ sth t5,0(t3) \ store halfword
+ countdown \ End inner loop when width=0
+
+ addic. t2,t2,-1 \ decrement height until =0
+ add t3,t3,t0 \ increment adr to next line
+ = until \ End outer loop when height=0
+
+ mtspr ctr,t6 \ Restore counter
+ lwzu tos,1cell(sp) \ Clean up stack
+ addi sp,sp,1cell
+c;
+
+\ Invert foreground and background colors within a rectangular region
+code fb32-invert ( adr width height bytes/line fg-color bg-color -- )
+ \ bg-color in tos
+ lwz t4,0(sp) \ fg-color in t4
+ lwzu t0,1cell(sp) \ bytes/line in scr
+ lwzu t2,1cell(sp) \ height in t1 (outer loop index, >0)
+ lwzu t1,1cell(sp) \ width in t2 (inner loop index, >0)
+ lwzu t3,1cell(sp) \ adr in sc3 (starting address)
+
+ mfspr t6,ctr \ Save counter
+
+ subf t0,t1,t0 \ Account for inner loop incrementing
+ addi t3,t3,-4 \ Account for inner loop incrementing
+
+ begin \ Outer loop
+ mtspr ctr,t1 \ Starting width value
+ begin \ Inner loop
+ lwzu t5,4(t3) \ read word
+ cmp 0,0,t5,tos \ Background?
+ = if
+ mr t5,t4 \ Set to foreground
+ else
+ cmp 0,0,t5,t4 \ Foreground?
+ = if
+ mr t5,tos \ Set to background
+ then
+ then
+ stw t5,0(t3) \ store word
+ countdown \ End inner loop when width=0
+
+ addic. t2,t2,-1 \ decrement height until =0
+ add t3,t3,t0 \ increment adr to next line
+ = until \ End outer loop when height=0
+
+ mtspr ctr,t6 \ Restore counter
+ lwzu tos,1cell(sp) \ Clean up stack
+ addi sp,sp,1cell
+c;
+
\ Draws a character from a 1-bit-deep font into an 8-bit-deep frame buffer
\ Assumptions: Fontbytes is 2; 0 < width <= 16
\ Fontadr is divisible by 2
@@ -106,6 +184,132 @@
addi sp,sp,4
c;
+\ Draws a character from a 1-bit-deep font into a 16-bit-deep frame buffer
+\ Assumptions: Fontbytes is 2; 0 < width <= 16
+\ Fontadr is divisible by 2
+code fb16-paint
+( fontadr fontbytes width height screenadr bytes/line fg-color bg-color -- )
+ \ tos already there \ bg-color in tos
+ lwz t9,0(sp) \ fg-color in t9
+ lwzu t2,1cell(sp) \ Bytes/line - bytes per scan line
+ lwzu t3,1cell(sp) \ Screenadr - start address in frame buffer
+ lwzu t4,1cell(sp) \ Height - character height in pixels
+ lwzu t5,1cell(sp) \ Width - character width in pixels (bytes)
+ lwzu t6,1cell(sp) \ Fontbytes - bytes per font line
+ lwzu t7,1cell(sp) \ Fontadr - start adr of this char in font table
+
+ addi t3,t3,-2 \ Account for pre-incrementing
+ subf t2,t5,t2 \ Account for inner loop incrementing
+ mfspr t8,ctr \ Save counter
+
+ addi r0,r0,8 \ Constant 8 (pixels/font-byte), needed below
+
+
+ begin \ Outer loop - for all scan lines in char
+ lbz t0,0(t7) \ Up to 8 font bits into scr
+ rlwinm t0,t0,23,1,8 \ Align almost to high part of word so that
+ \ one more shift will affect the sign bit
+
+ mr t1,t5 \ Reset width counter for the new scan line
+
+ ahead \ Branch down to end of loop
+ begin
+
+ cmpi 0,0,t1,8
+ < if
+ mtspr ctr,t1 \ Set count
+ subf t1,t1,t1 \ Width is exhausted
+ else
+ mtspr ctr,r0 \ Max inner loop count is 8
+ addi t1,t1,-8 \ Reduce width by 8
+ then
+
+ begin \ Inner loop - for each pixel in a font byte
+ add. t0,t0,t0 \ Shift next pixel bit to top position
+ 0< if
+ sthu t9,2(t3) \ Write foreground color to framebuffer
+ else
+ sthu tos,2(t3) \ Write background color to framebuffer
+ then
+ countdown \ Repeat until width count = 0
+
+ but then
+ cmpi 0,0,t1,0
+ = until
+
+ add t7,t7,t6 \ Next scan line in font table
+ addic. t4,t4,-1 \ Decrement height counter
+ add t3,t3,t2 \ Increment frame buffer addr to next line
+ = until \ Repeat until height count = 0
+
+ mtspr ctr,t8 \ Restore counter
+ lwzu tos,4(sp) \ Clean up stack
+ addi sp,sp,4
+c;
+
+\ Draws a character from a 1-bit-deep font into a 32-bit-deep frame buffer
+\ Assumptions: Fontbytes is 2; 0 < width <= 16
+\ Fontadr is divisible by 2
+code fb32-paint
+( fontadr fontbytes width height screenadr bytes/line fg-color bg-color -- )
+ \ tos already there \ bg-color in tos
+ lwz t9,0(sp) \ fg-color in t9
+ lwzu t2,1cell(sp) \ Bytes/line - bytes per scan line
+ lwzu t3,1cell(sp) \ Screenadr - start address in frame buffer
+ lwzu t4,1cell(sp) \ Height - character height in pixels
+ lwzu t5,1cell(sp) \ Width - character width in pixels (bytes)
+ lwzu t6,1cell(sp) \ Fontbytes - bytes per font line
+ lwzu t7,1cell(sp) \ Fontadr - start adr of this char in font table
+
+ addi t3,t3,-4 \ Account for pre-incrementing
+ subf t2,t5,t2 \ Account for inner loop incrementing
+ mfspr t8,ctr \ Save counter
+
+ addi r0,r0,8 \ Constant 8 (pixels/font-byte), needed below
+
+
+ begin \ Outer loop - for all scan lines in char
+ lbz t0,0(t7) \ Up to 8 font bits into scr
+ rlwinm t0,t0,23,1,8 \ Align almost to high part of word so that
+ \ one more shift will affect the sign bit
+
+ mr t1,t5 \ Reset width counter for the new scan line
+
+ ahead \ Branch down to end of loop
+ begin
+
+ cmpi 0,0,t1,8
+ < if
+ mtspr ctr,t1 \ Set count
+ subf t1,t1,t1 \ Width is exhausted
+ else
+ mtspr ctr,r0 \ Max inner loop count is 8
+ addi t1,t1,-8 \ Reduce width by 8
+ then
+
+ begin \ Inner loop - for each pixel in a font byte
+ add. t0,t0,t0 \ Shift next pixel bit to top position
+ 0< if
+ stwu t9,4(t3) \ Write foreground color to framebuffer
+ else
+ stwu tos,4(t3) \ Write background color to framebuffer
+ then
+ countdown \ Repeat until width count = 0
+
+ but then
+ cmpi 0,0,t1,0
+ = until
+
+ add t7,t7,t6 \ Next scan line in font table
+ addic. t4,t4,-1 \ Decrement height counter
+ add t3,t3,t2 \ Increment frame buffer addr to next line
+ = until \ Repeat until height count = 0
+
+ mtspr ctr,t8 \ Restore counter
+ lwzu tos,4(sp) \ Clean up stack
+ addi sp,sp,4
+c;
+
\ Very fast window move, for scrolling
\ Similar to 'move', but only moves #move/line out of every 'bytes/line' bytes
\ Assumes bytes/line is divisible by 8 (for double-long load/stores)
@@ -123,7 +327,7 @@
4 constant fbalign
[then]
-code fb8-window-move ( src-start dst-start size bytes/line #move/line -- )
+code fb-window-move ( src-start dst-start size bytes/line #move/line -- )
\ tos=#move/line
lwz t0,0(sp) \ t0=bytes/line
lwzu t1,1cell(sp) \ t1=size
Modified: cpu/ppc/kerncode.fth
===================================================================
--- cpu/ppc/kerncode.fth 2009-11-19 17:19:33 UTC (rev 1493)
+++ cpu/ppc/kerncode.fth 2009-11-20 21:01:27 UTC (rev 1494)
@@ -695,7 +695,40 @@
pop2
c;
+code wfill (s start-adr count w -- )
+ \ 16-bit data in tos
+ second-to-t0 \ count in t0
+ third-to-t1 \ dst in t1
+
+ addi t1,t1,-2 \ Account for pre-increment
+ rlwinm t0,t0,31,1,31 \ Divide count by 2
+ mfspr t2,ctr \ Save CTR
+ mtspr ctr,t0
+ begin
+ sthu tos,2(t1)
+ countdown
+ mtspr ctr,t2
+ pop2
+c;
+
+code lfill (s start-adr count long -- )
+ \ 32-bit data in tos
+ second-to-t0 \ count in t0
+ third-to-t1 \ dst in t1
+
+ addi t1,t1,-1cell \ Account for pre-increment
+ rlwinm t0,t0,30,2,31 \ Divide count by 4
+ mfspr t2,ctr \ Save CTR
+ mtspr ctr,t0
+ begin
+ stwu tos,1cell(t1)
+ countdown
+ mtspr ctr,t2
+
+ pop2
+c;
+
code noop (s -- ) c;
code lowbyte (s n -- low ) andi. tos,tos,h#ff c;
Modified: ofw/termemu/fb8.fth
===================================================================
--- ofw/termemu/fb8.fth 2009-11-19 17:19:33 UTC (rev 1493)
+++ ofw/termemu/fb8.fth 2009-11-20 21:01:27 UTC (rev 1494)
@@ -241,6 +241,7 @@
loop 2drop ( )
;
+[ifdef] cursor-w
[ifndef] fb8-merge
: fb8-merge ( color bits dst-adr width -- )
bounds ?do ( color mask )
@@ -289,6 +290,7 @@
loop
4drop
;
+[then]
headers
: fb8-insert-characters ( #chars -- )
@@ -317,7 +319,9 @@
['] fb8-invert to fb-invert
['] fill to fb-fill
['] fb8-paint to fb-paint
+[ifdef] fb8-merge
['] fb8-merge to fb-merge
+[then]
['] colors-8bpp to fb-16map
endof
@@ -326,7 +330,9 @@
['] fb16-invert to fb-invert
['] wfill to fb-fill
['] fb16-paint to fb-paint
+[ifdef] fb16-merge
['] fb16-merge to fb-merge
+[then]
['] colors-565 to fb-16map
endof
@@ -335,7 +341,9 @@
['] fb32-invert to fb-invert
['] lfill to fb-fill
['] fb32-paint to fb-paint
+[ifdef] fb32-merge
['] fb32-merge to fb-merge
+[then]
['] colors-32bpp to fb-16map
endof
endcase
More information about the openfirmware
mailing list