Author: wmb
Date: 2009-04-23 10:20:15 +0200 (Thu, 23 Apr 2009)
New Revision: 1157
Added:
dev/via/
dev/via/unichrome/
dev/via/unichrome/build/
dev/via/unichrome/loadpkg.fth
dev/via/unichrome/pci.fth
dev/via/unichrome/unichrome.bth
dev/via/unichrome/unichrome.fth
Log:
Added driver for Via Unichrome display adapter.
Added: dev/via/unichrome/loadpkg.fth
===================================================================
--- dev/via/unichrome/loadpkg.fth (rev 0)
+++ dev/via/unichrome/loadpkg.fth 2009-04-23 08:20:15 UTC (rev 1157)
@@ -0,0 +1,35 @@
+\ See license at end of file
+purpose: Main load file for Via Unichrome frame buffer driver
+
+" display" device-name
+
+fload ${BP}/dev/via/unichrome/pci.fth \ PCI interfaces
+fload ${BP}/dev/via/unichrome/unichrome.fth \ Controller code
+\ fload ${BP}/dev/via/unichrome/accel2d.fth \ Accelerator
+\ fload ${BP}/dev/via/unichrome/gxvga.fth \ Text mode support
+fload ${BP}/dev/video/common/rectangle16.fth \ Rectangular graphics
+fload ${BP}/cpu/x86/pc/olpc/expand16.fth \ Expand image by 2x
+
+\ LICENSE_BEGIN
+\ Copyright (c) 2006 FirmWorks
+\
+\ Permission is hereby granted, free of charge, to any person obtaining
+\ a copy of this software and associated documentation files (the
+\ "Software"), to deal in the Software without restriction, including
+\ without limitation the rights to use, copy, modify, merge, publish,
+\ distribute, sublicense, and/or sell copies of the Software, and to
+\ permit persons to whom the Software is furnished to do so, subject to
+\ the following conditions:
+\
+\ The above copyright notice and this permission notice shall be
+\ included in all copies or substantial portions of the Software.
+\
+\ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+\ EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+\ MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
+\ NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
+\ LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
+\ OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
+\ WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+\
+\ LICENSE_END
Added: dev/via/unichrome/pci.fth
===================================================================
--- dev/via/unichrome/pci.fth (rev 0)
+++ dev/via/unichrome/pci.fth 2009-04-23 08:20:15 UTC (rev 1157)
@@ -0,0 +1,58 @@
+\ See license at end of file
+purpose: PCI footprint for Via Unichrome graphics controller
+
+hex
+headers
+
+: phys+ encode-phys encode+ ;
+: i+ encode-int encode+ ;
+
+0 0 encode-bytes
+0 0 h# 0000.0000 my-space + phys+ 0 i+ h# 0000.0100 i+ \ Config registers
+0 0 h# 0200.0010 my-space + phys+ 0 i+ h# 0400.0000 i+ \ Frame buffer
+0 0 h# 0200.0014 my-space + phys+ 0 i+ h# 0100.0000 i+ \ MMIO stuff
+" reg" property
+
+: map-membar ( bar size -- adr )
+ >r
+ my-space + h# 0200.0000 or 0 0 rot ( phys )
+ r> " map-in" $call-parent
+;
+: unmap ( adr size -- ) " map-out" $call-parent ;
+: (map-io-regs) ( -- mmio-base )
+ h# 14 h# 0080.0000 map-membar ( mmio-base )
+;
+: (map-frame-buffer) ( -- adr )
+ \ Not the whole thing, but enough for our needs
+ h# 10 h# 0080.0000 map-membar
+;
+
+\ This is called during probing by make-function-node
+: init ( -- )
+ " make-compatible-property" my-parent ihandle>phandle find-method if execute then
+ " make-power-property" my-parent ihandle>phandle find-method if execute then
+;
+
+\ LICENSE_BEGIN
+\ Copyright (c) 2009 FirmWorks
+\
+\ Permission is hereby granted, free of charge, to any person obtaining
+\ a copy of this software and associated documentation files (the
+\ "Software"), to deal in the Software without restriction, including
+\ without limitation the rights to use, copy, modify, merge, publish,
+\ distribute, sublicense, and/or sell copies of the Software, and to
+\ permit persons to whom the Software is furnished to do so, subject to
+\ the following conditions:
+\
+\ The above copyright notice and this permission notice shall be
+\ included in all copies or substantial portions of the Software.
+\
+\ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+\ EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+\ MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
+\ NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
+\ LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
+\ OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
+\ WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+\
+\ LICENSE_END
Added: dev/via/unichrome/unichrome.bth
===================================================================
--- dev/via/unichrome/unichrome.bth (rev 0)
+++ dev/via/unichrome/unichrome.bth 2009-04-23 08:20:15 UTC (rev 1157)
@@ -0,0 +1,14 @@
+purpose: Load file for Via Unichrome Frame Buffer FCode driver
+
+command: &tokenize &this
+build-now
+
+silent on
+
+begin-tokenizing unichrome.fc
+
+FCode-version2
+fload ${BP}/dev/via/unichrome/loadpkg.fth
+end0
+
+end-tokenizing
Added: dev/via/unichrome/unichrome.fth
===================================================================
--- dev/via/unichrome/unichrome.fth (rev 0)
+++ dev/via/unichrome/unichrome.fth 2009-04-23 08:20:15 UTC (rev 1157)
@@ -0,0 +1,559 @@
+purpose: Driver for Via Unichrome Pro, model VX855
+
+
+hex
+headers
+
+
+\ width and height are global instead of instance values because
+\ the seltest method needs to get their values in a fresh instance
+\ with re-running the open method.
+d# 1280 ( instance ) value width \ Frame buffer line width
+d# 1024 ( instance ) value height \ Screen height
+d# 16 instance value depth \ Bits per pixel
+d# 1024 instance value /scanline \ Frame buffer line width
+
+: declare-props ( -- ) \ Instantiate screen properties
+ " width" get-my-property if
+ width encode-int " width" property
+ height encode-int " height" property
+ depth encode-int " depth" property
+ /scanline encode-int " linebytes" property
+ else
+ 2drop
+ then
+;
+
+: /fb ( -- ) /scanline height * ; \ Size of framebuffer
+
+0 instance value mmio-base
+
+: map-io-regs ( -- )
+ mmio-base if exit then
+ (map-io-regs) to mmio-base
+ h# 4 my-space + " config-w@" $call-parent 7 or
+ h# 4 my-space + " config-w!" $call-parent
+;
+
+: map-frame-buffer ( -- )
+ (map-frame-buffer) to frame-buffer-adr
+ frame-buffer-adr encode-int " address" property
+;
+
+
+\ VGA register access
+
+\ reset attribute address flip-flop
+: reset-attr-addr ( -- ) h# 3da ( input-status1 ) pc@ drop ;
+
+: video-mode! ( b -- ) reset-attr-addr h# 03c0 pc! ;
+: attr! ( b index -- ) reset-attr-addr h# 03c0 pc! h# 03c0 pc! ;
+: attr@ ( index -- b )
+ reset-attr-addr h# 03c0 pc! h# 03c1 pc@ reset-attr-addr
+;
+: grf! ( b index -- ) h# 03ce pc! h# 03cf pc! ;
+: grf@ ( index -- b ) h# 03ce pc! h# 03cf pc@ ;
+
+: crt@ ( index -- byte ) h# 3d4 pc! h# 3d5 pc@ ;
+: crt! ( byte index -- ) h# 3d4 pc! h# 3d5 pc! ;
+
+: seq@ ( index -- byte ) h# 3c4 pc! h# 3c5 pc@ ;
+: seq! ( byte index -- ) h# 3c4 pc! h# 3c5 pc! ;
+
+: misc@ ( -- byte ) h# 3cc pc@ ;
+: misc! ( byte -- ) h# 3c2 pc! ;
+
+: pll, ( v44 v45 v46 misc -- ) bljoin l, ;
+
+\ Timing table for various resolutions
+
+decimal
+create res-table
+\ width height htotal hsync hsyncend vtotal vsync vsyncend --pll-- misc
+ 640 w, 480 w, 800 w, 656 w, 752 w, 525 w, 489 w, 523 w, hex 8d 10 05 cf pll, decimal
+ 800 w, 600 w, 1056 w, 840 w, 968 w, 628 w, 600 w, 619 w, hex 70 0c 05 0f pll, decimal
+ 1024 w, 768 w, 1344 w, 1048 w, 1184 w, 806 w, 770 w, 776 w, hex b6 0c 05 cf pll, decimal
+ 1280 w, 768 w, 1664 w, 1344 w, 1472 w, 798 w, 770 w, 777 w, hex 6f 08 05 4f pll, decimal
+ 1280 w, 800 w, 1680 w, 1352 w, 1480 w, 831 w, 802 w, 808 w, hex 46 88 83 4f pll, decimal
+ 1280 w, 1024 w, 1688 w, 1328 w, 1440 w, 1066 w, 1024 w, 1027 w, hex 97 08 05 0f pll, decimal
+ 1368 w, 768 w, 1800 w, 1440 w, 1584 w, 795 w, 768 w, 771 w, hex 78 88 85 0f pll, decimal
+ 1440 w, 900 w, 1904 w, 1520 w, 1672 w, 934 w, 902 w, 908 w, hex 77 08 04 4f pll, decimal
+ 1600 w, 1200 w, 2160 w, 1664 w, 1856 w, 1250 w, 1200 w, 1219 w, hex 71 04 05 0f pll, decimal
+ 1680 w, 1050 w, 2240 w, 1784 w, 1960 w, 1089 w, 1052 w, 1058 w, hex ce 08 05 4f pll, decimal
+ 1920 w, 1080 w, 2576 w, 2048 w, 2248 w, 1120 w, 1082 w, 1103 w, hex 79 04 05 0f pll, decimal
+ 1920 w, 1200 w, 2592 w, 2056 w, 2256 w, 1245 w, 1202 w, 1224 w, hex 87 04 05 4f pll, decimal
+here res-table - constant /res-table
+
+: /res-entry ( -- n ) 8 /w* la1+ ;
+
+\ width height htotal hsync hsyncend vtotal vsync vsyncend --pll-- misc
+create mode3-table
+ 640 w, 400 w, 800 w, 680 w, 776 w, 449 w, 412 w, 430 w, hex 35 04 05 67 pll, decimal
+
+\ width height htotal hsync hsyncend vtotal vsync vsyncend --pll-- misc
+create mode12-table
+ 640 w, 480 w, 800 w, 672 w, 768 w, 525 w, 490 w, 492 w, hex 35 04 05 e3 pll, decimal
+
+0 value res-entry
+
+: mode-3? ( -- flag ) res-entry mode3-table = ;
+: mode-12? ( -- flag ) res-entry mode12-table = ;
+
+: find-timing-table ( width height -- error? )
+ res-table /res-table bounds ?do ( width height )
+ over i w@ = if ( width height )
+ dup i wa1+ w@ = if ( width height )
+ i to res-entry ( width height )
+ 2drop false ( false )
+ unloop exit
+ then ( width height )
+ then ( width height )
+ /res-entry +loop ( width height )
+ 2drop true ( true)
+;
+
+hex
+
+\ Stored values from table
+: htotal ( -- n ) res-entry 2 wa+ w@ ;
+: hsync ( -- n ) res-entry 3 wa+ w@ ;
+: hsyncend ( -- n ) res-entry 4 wa+ w@ ;
+: vtotal ( -- n ) res-entry 5 wa+ w@ ;
+: vsync ( -- n ) res-entry 6 wa+ w@ ;
+: vsyncend ( -- n ) res-entry 7 wa+ w@ ;
+: pll ( -- l ) res-entry 8 wa+ l@ ;
+: miscval ( -- b ) pll lbsplit nip nip nip ;
+
+\ Derived values
+: hdisplay ( -- n ) width ;
+: hblank ( -- n )
+ width
+ mode-3? if 8 + then
+ mode-12? if 8 + then
+;
+: hblankend ( -- n )
+ mode-3? mode-12? or if d# 792 else htotal then
+;
+: vdisplay ( -- n ) height ;
+: vblank ( -- n )
+ height
+ mode-3? if 7 + then
+ mode-12? if 8 + then
+;
+: vblankend ( -- n )
+ mode-3? if d# 442 exit then
+ mode-12? if d# 517 exit then
+ vtotal
+;
+\ End of section that determines the mode-dependent basic timing parameters
+
+: use-ext-clock ( -- ) misc@ h# c or misc! ;
+: set-primary-dotclock ( clock -- )
+ lbsplit drop h# 46 seq! h# 45 seq! h# 44 seq!
+
+ 40 seq@ dup 2 or 40 seq! 2 invert and 40 seq! \ Pulse VCK PLL reset high
+;
+: set/clr ( value mask on? -- ) if or else invert and then ;
+: set-dvp-power ( on? -- )
+ h# 1e seq@ h# 30
+ rot set/clr
+ h# 1e seq!
+;
+: set-vcp-power ( on? -- )
+ h# 1e seq@ h# c0
+ rot set/clr
+ h# 1e seq!
+;
+: set-spread-spectrum ( on? -- )
+ h# 1e seq@ 8
+ rot set/clr
+ h# 1e seq!
+;
+
+: set-gamma ( on? -- )
+ >r
+ h# 33 crt@ h# 80
+ r@ set/clr
+ h# 33 crt!
+
+ \ DVP
+ h# 32 crt@ h# 2
+ r@ set/clr
+ h# 32 crt!
+
+ \ LCD
+ h# 6a crt@ h# 2
+ r> set/clr
+ h# 6a crt!
+;
+\ Unichrome driver uses the wrong bit for enabling DVP "Grammar" correction
+
+: bitclr ( value mask -- ) invert and ;
+: crt-mask ( value mask reg# -- )
+ >r r@ crt@ ( value mask oldval )
+ over bitclr ( value mask oldval' )
+ -rot and or ( val' )
+ r> crt!
+;
+: seq-mask ( value mask reg# -- )
+ >r r@ seq@ ( value mask oldval )
+ over bitclr ( value mask oldval' )
+ -rot and or ( val' )
+ r> seq!
+;
+
+: seq-set ( mask reg# -- ) tuck seq@ or swap seq! ;
+: seq-clr ( mask reg# -- ) tuck seq@ swap invert and swap seq! ;
+
+: crt-set ( mask reg# -- ) tuck crt@ or swap crt! ;
+: crt-clr ( mask reg# -- ) tuck crt@ swap invert and swap crt! ;
+
+: pixels>bytes ( pixels -- bytes )
+ depth d# 24 = if d# 32 else depth then * 3 >> ( bytes )
+;
+: bytes>chunks ( bytes -- chunks ) 3 >> 4 round-up ;
+
+: lower-power ( -- )
+ 7f 19 seq! \ clock gating
+ 30 1b seq! \ clock gating
+ f3 2d seq! \ Power control enables
+ ff 2e seq! \ clock gating
+ ff 3f seq! \ clock gating
+ 5f 4f seq! \ clock gating threshold
+ df 59 seq! \ clock gating
+ 01 36 crt! \ Enable PCI power management control
+ 34 37 crt! \ DAC power savings
+
+ 00 a8 seq! \ leave on ROC ECK in C0
+ 00 a9 seq! \ leave on ROC ECK in C1
+ 80 aa seq! \ gate off ROC ECK in C4
+ 80 ab seq! \ gate off ROC ECK in C3
+ 00 ac seq! \ leave on ROC ECK in S3
+ 00 ad seq! \ leave on ROC ECK in S1 Snapshot
+ 00 ae seq! \ leave on ROC ECK in C4P
+ 00 af seq! \ leave on ROC ECK in reserved state
+;
+
+: legacy-settings ( -- )
+ \ Some EGA legacy mode settings
+ 03 00 seq! \ Release reset bits
+ 01 01 seq! \ 8/9 timing (0 for mode 3)
+ 0f 02 seq! \ Enable map planes 0 and 1 (3 for mode 3)
+ 00 03 seq! \ Character map select
+ 0e 04 seq! \ Extended memory present (2 for mode 3)
+ 0d 0a crt! \ Cursor start (text mode)
+ 0e 0b crt! \ Cursor end (text mode)
+ 00 0e crt! \ Cursor loc (text mode)
+ 00 0f crt! \ Cursor loc (text mode)
+ 10 11 crt! \ Refreshes per line, disable vertical interrupt (60 in mode 3, 70 in mode 12)
+ 23 17 crt! \ address wrap, sequential access, not CGA compat mode (63 in mode 12)
+
+ 04 0e crt! \ Make the register dump match the snapshots
+ 60 0f crt!
+ 01 49 crt!
+;
+
+: general-init ( -- )
+ 1e seq@ 1 or 1e seq! \ ROC ECK
+ 00 20 seq! \ max queuing number (but manual recommends 4)
+ 10 22 seq! \ (display queue request expire number)
+ 40 34 seq! \ not documented
+ 01 3b seq! \ not documented
+ 38 40 seq! \ ECK freq
+ 30 4d seq! \ preempt arbiter
+ 08 30 crt! \ DAC speed enhancement
+\ 00 38 crt! \ Signature 0 - not writable, empirically
+\ 21 39 crt! \ Signature 1
+\ 32 3a crt! \ Signature 2
+ 01 3b crt! \ Scratch 2
+ 08 3c crt! \ Scratch 3
+ c0 f7 crt! \ Spread spectrum
+ 01 32 crt! \ real time flipping (I think we can ignore this)
+;
+\ SRs set in romreset: 35-38,39,4c,68,6d-6f,78,f3
+
+: tune-fifos ( -- )
+ 20 3f 16 seq-mask \ FIFO threshold (VX855 value) (value is c in modes 3 and 12)
+ 7f ff 17 seq-mask \ FIFO depth (VX855 value) (value is 1f in modes 3 and 12)
+ 60 ff 18 seq-mask \ Display Arbiter (VX855 value)
+
+ 18 21 seq! \ (typical request track FIFO number channel 0
+ 1f 50 seq! \ FIFO
+ 81 51 seq! \ FIFO
+ 00 57 seq! \ FIFO
+ 08 58 seq! \ FIFO
+ 20 66 seq! \ request kill
+ 20 67 seq! \ request kill
+ 20 69 seq! \ request kill
+ 20 70 seq! \ request kill
+ 0f 72 seq! \ FIFO
+ 08 79 seq! \ request kill
+ 10 7a seq! \ request kill
+ c8 7c seq! \ request kill
+;
+: mode-independent-init ( -- )
+ general-init legacy-settings tune-fifos lower-power
+;
+
+: set-primary-vga-mode ( -- )
+ 80 11 crt-clr \ Enable writing to CRT0-7
+ 80 03 crt-set \ Enable vertical retrace access
+ 01 10 seq! \ Unlock extended registers
+
+ miscval misc!
+
+\ 0 0 seq! \ Sequence registers
+
+\ 01 df 01 seq-mask
+\ 00 03 seq!
+
+\ a2 e2 15 seq-mask \ (22 for mode 3, for 6-bit LUT)
+ 22 e2 15 seq-mask \ (22 for mode 3, for 6-bit LUT)
+ depth case
+ 8 of 00 endof
+ d# 16 of 14 endof
+ d# 24 of 0c endof
+ d# 32 of 0c endof
+ endcase
+ 1c 15 seq-mask
+
+ 28 fd 1a seq-mask \ Extended mode memory access (value is 20 in modes 3 and 12)
+
+ " "(00 00 00 00 00 00 05 0f ff)" 0 do ( adr )
+ dup c@ i grf! 1+
+ loop drop
+
+\ For mode 13, add: 40 5 grf!
+\ For mode 3, add: 10 5 grf! 0e 6 grf! 0 7 grf!
+
+ 0 20 grf! 0 21 grf! 0 22 grf!
+
+ \ AT6 is 6 not 14, AT8-f is 8-f, not 38-3f (different intensities)
+ 10 0 do i i attr! loop
+ 01 10 attr! \ mode control (0c for text mode 3)
+ 00 11 attr! \ overscan color
+ 0f 12 attr! \ color plane enable
+ 00 13 attr! \ horizontal pixel pan - (08 for text mode 3)
+ 00 14 attr! \ high bits of color palette index
+
+ htotal 3 >> 5 - dup 00 crt! 5 >> 08 36 crt-mask
+
+ hdisplay 3 >> 1- 01 crt!
+ hblank 3 >> 1- 02 crt!
+
+ hblankend 3 >> 1- dup 1f 03 crt-mask dup 2 << 80 05 crt-mask 1 >> 20 33 crt-mask
+
+ hsync 3 >> dup 04 crt! 4 >> 10 33 crt-mask
+ hsyncend 3 >> 1f 05 crt-mask
+
+ vtotal 2- dup 06 crt! dup 8 >> 01 07 crt-mask dup 4 >> 20 07 crt-mask d# 10 >> 01 35 crt-mask
+ vdisplay 1- dup 12 crt! dup 7 >> 02 07 crt-mask dup 3 >> 40 07 crt-mask 8 >> 04 35 crt-mask
+
+ \ Starting address
+ 0 0c crt! 0 0d crt! 0 34 crt! 0 3 48 crt-mask
+
+ vsync dup 10 crt! dup 6 >> 04 07 crt-mask dup 2 >> 80 07 crt-mask 9 >> 02 35 crt-mask
+ vsyncend 0f 11 crt-mask
+
+ \ Line compare value 3fff
+ ff 18 crt! 10 7 crt-set 40 9 crt-set 10 35 crt-set
+
+ \ HSYNC adjust
+ 06 07 33 crt-mask \ 01 for text mode 3, 00 for mode 12
+
+ \ Max scan line value 0
+ 1f 9 crt-clr 1f 14 crt!
+
+ vblank 1- dup 15 crt! dup 5 >> 08 07 crt-mask dup 4 >> 20 09 crt-mask 7 >> 08 35 crt-mask
+ vblankend 1- 16 crt!
+
+ 00 08 crt! \ Preset row scan
+\ 00 32 crt! \ HSYNC delay, SYNC drive, gamma, end blanking, etc Already set
+ c8 33 crt-clr \ Gamma, interlace, prefetch, HSYNC shift
+
+ \ Offset
+ width pixels>bytes to /scanline
+ /scanline bytes>chunks dup 13 crt! 3 >> e0 35 crt-mask
+
+ \ fetch count
+ hdisplay pixels>bytes bytes>chunks 8 + dup 1 >> 1c seq! 9 >> 03 1d seq-mask
+;
+
+\ XXX unichrome has duplicate setting of regs CR32 and CR33 near end of ViaModePrimaryVGA
+
+: set-primary-mode ( width height depth -- error? )
+ to depth to height to width
+ width height find-timing-table ?dup if exit then
+
+ 80 17 crt-clr \ Assert reset
+
+ mode-independent-init
+
+ \ Clean Second Path Status
+ 00 f6 6a crt-mask
+ 00 6b crt!
+ 00 6c crt!
+ 00 93 crt!
+
+ set-primary-vga-mode
+
+ 08 1a seq-set \ Enable MMIO
+
+\ 08 33 crt-set \ Enable CRT prefetch (VESA BIOS doesn't set this)
+
+\ depth 8 <> set-gamma \ No gamma for 8bpp palette mode
+ false set-gamma
+
+ \ Maybe do some power-up thingy here
+ pll set-primary-dotclock
+
+ use-ext-clock
+
+\ 01 6b crt-clr \ Appears to be reserved RO bit
+
+ 80 17 crt-set \ Release reset
+ false \ No error
+;
+
+0 [if]
+: set-secondary-dotclock ( clock -- )
+ lbsplit drop h# 4a seq! h# 4b seq! h# 4c seq!
+
+ 40 seq@ dup 4 or 40 seq! 4 invert and 40 seq! \ Pulse LCDCK PLL reset high
+;
+: set-secondary-vga-mode ( mode -- )
+ depth case
+ 8 of 00 endof
+ d# 16 of 40 endof
+ d# 24 of 80 endof
+ d# 32 of 80 endof
+ endcase
+ c0 67 crt-mask
+
+ htotal 1- dup 50 crt! 8 >> 0f 55 crt-mask
+ hdisplay 1- dup 51 crt! 4 >> 70 55 crt-mask
+ hblank 1- dup 52 crt! 8 >> 07 54 crt-mask
+ hblankend 1- dup 53 crt! dup 5 >> 38 54 crt-mask 5 >> 40 5d crt-mask
+
+\ unichrome omits bit 11, which goes in CR5D[7]
+ hsync dup 56 crt! dup 2 >> c0 54 crt-mask dup 3 >> 80 5c crt-mask 4 >> 80 5d crt-mask
+ hsyncend dup 57 crt! 2 >> 40 5c crt-mask
+
+ vtotal 1- dup 58 crt! 8 >> 07 5d crt-mask
+ vdisplay 1- dup 59 crt! 5 >> 38 5d crt-mask
+
+ vblank 1- dup 5a crt! 8 >> 07 5c crt-mask
+ vblankend 1- dup 5b crt! 5 >> 38 5c crt-mask
+
+ vsync dup 5e crt! 3 >> e0 5f crt-mask
+ vsyncend 5f 1f crt-mask
+
+ \ Offset
+ width pixels>bytes bytes>chunks dup 66 crt! 8 >> 03 67 crt-mask
+
+ \ fetch count
+ hdisplay pixels>bytes bytes>chunks 8 + dup 1 >> 65 crt! 7 >> 0c 67 crt-mask
+;
+
+: set-secondary-mode ( -- )
+ 80 17 crt-clr \ Assert reset - Turn off screen
+ set-secondary-vga-mode
+ \ Turn on power here?
+ 1e 6c crt-clr
+ dotclock set-secondary-dotclock
+ use-ext-clock
+ 80 17 crt-set \ Release reset
+;
+[then]
+
+hex
+0 [if]
+: .cr
+ h# 20 0 do
+ i 2 u.r space
+ i h# 10 bounds do i crt@ 3 u.r loop cr
+ h# 10 +loop
+ h# 100 h# 30 do
+ i 2 u.r space
+ i h# 10 bounds do i crt@ 3 u.r loop cr
+ h# 10 +loop
+;
+: .sr
+ h# 80 0 do
+ i 2 u.r space
+ i h# 10 bounds do i seq@ 3 u.r loop cr
+ h# 10 +loop
+ h# b0 h# a0 do
+ i 2 u.r space
+ i h# 10 bounds do i seq@ 3 u.r loop cr
+ h# 10 +loop
+;
+: .gr 9 0 do i grf@ 3 u.r loop cr ;
+
+: bios-table-adr ( -- adr ) h# c001b w@ h# c0000 + ;
+[then]
+
+defer init-hook ' noop is init-hook
+
+: init-all ( -- ) \ Initializes the controller
+\ smb-init
+ map-io-regs \ Enable IO registers
+ width height depth set-primary-mode drop
+ declare-props \ Setup properites
+\ set-dac-colors \ Set up initial color map
+\ video-on \ Turn on video
+
+ map-frame-buffer
+ depth case
+ 8 of frame-buffer-adr /fb h# 0f fill endof
+ d# 16 of frame-buffer-adr /fb background-rgb rgb>565 wfill endof
+ d# 32 of frame-buffer-adr /fb h# ffff.ffff lfill endof
+ endcase
+ h# f to background-color
+;
+
+: display-remove ( -- )
+;
+
+: display-install ( -- )
+ init-all
+ default-font set-font
+ width height ( width height )
+ over char-width / over char-height / ( width height rows cols )
+ /scanline depth fb-install ( gp-install ) ( )
+ init-hook
+;
+
+: display-selftest ( -- failed? ) false ;
+
+' display-install is-install
+' display-remove is-remove
+' display-selftest is-selftest
+
+" display" device-type
+" ISO8859-1" encode-string " character-set" property
+0 0 encode-bytes " iso6429-1983-colors" property
+
+\ LICENSE_BEGIN
+\ Copyright (c) 2009 FirmWorks
+\
+\ Permission is hereby granted, free of charge, to any person obtaining
+\ a copy of this software and associated documentation files (the
+\ "Software"), to deal in the Software without restriction, including
+\ without limitation the rights to use, copy, modify, merge, publish,
+\ distribute, sublicense, and/or sell copies of the Software, and to
+\ permit persons to whom the Software is furnished to do so, subject to
+\ the following conditions:
+\
+\ The above copyright notice and this permission notice shall be
+\ included in all copies or substantial portions of the Software.
+\
+\ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+\ EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+\ MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
+\ NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
+\ LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
+\ OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
+\ WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+\
+\ LICENSE_END
