Subversion Repositories planix.SVN

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
2 - 1 
#include "u.h"
2 
#include "../port/lib.h"
3 
#include "mem.h"
4 
#include "dat.h"
5 
#include "fns.h"
6 
#include "io.h"
7 
#include "../port/error.h"
8 
 
9 
#define	Image	IMAGE
10 
#include <draw.h>
11 
#include <memdraw.h>
12 
#include <cursor.h>
13 
#include "screen.h"
14 
 
15 
static void
16 
ct65545page(VGAscr*, int page)
17 
{
18 
	outb(0x3D6, 0x10);
19 
	outb(0x3D7, page<<6);
20 
}
21 
 
22 
static void
23 
ct65545disable(VGAscr*)
24 
{
25 
	outl(0xA3D0, 0);
26 
}
27 
 
28 
static void
29 
ct65545enable(VGAscr* scr)
30 
{
31 
	ulong storage;
32 
 
33 
	/*
34 
	 * Find a place for the cursor data in display memory.
35 
	 * Must be on a 1024-byte boundary.
36 
	 */
37 
	storage = ROUND(scr->gscreen->width*BY2WD*scr->gscreen->r.max.y, 1024);
38 
	outl(0xB3D0, storage);
39 
	scr->storage = storage;
40 
 
41 
	/*
42 
	 * Set the colours.
43 
	 * Enable the cursor.
44 
	 */
45 
	outl(0xA7D0, 0xFFFF0000);
46 
	outl(0xA3D0, 2);
47 
}
48 
 
49 
static void
50 
ct65545initcursor(VGAscr* scr, int xo, int yo, int index)
51 
{
52 
	uchar *mem;
53 
	uint and, clr, set, xor;
54 
	int i, x, y;
55 
 
56 
	mem = scr->vaddr;
57 
	mem += scr->storage + index*1024;
58 
 
59 
	for(y = yo; y < 16; y++){
60 
		clr = (scr->clr[2*y]<<8)|scr->clr[2*y+1];
61 
		set = (scr->set[2*y]<<8)|scr->set[2*y+1];
62 
		if(xo){
63 
			clr <<= xo;
64 
			set <<= xo;
65 
		}
66 
 
67 
		and = 0;
68 
		xor = 0;
69 
		for(i = 0; i < 16; i++){
70 
			if(set & (1<<i)){
71 
				/* nothing to do */
72 
			}
73 
			else if(clr & (1<<i))
74 
				xor |= 1<<i;
75 
			else
76 
				and |= 1<<i;
77 
		}
78 
		*mem++ = and>>8;
79 
		*mem++ = xor>>8;
80 
		*mem++ = and;
81 
		*mem++ = xor;
82 
 
83 
		for(x = 16; x < 64; x += 8){
84 
			*mem++ = 0xFF;
85 
			*mem++ = 0x00;
86 
		}
87 
	}
88 
	while(y < 64+yo){
89 
		for(x = 0; x < 64; x += 8){
90 
			*mem++ = 0xFF;
91 
			*mem++ = 0x00;
92 
		}
93 
		y++;
94 
	}
95 
}
96 
 
97 
static void
98 
ct65545load(VGAscr* scr, Cursor* curs)
99 
{
100 
	memmove(&scr->Cursor, curs, sizeof(Cursor));
101 
	ct65545initcursor(scr, 0, 0, 0);
102 
}
103 
 
104 
static int
105 
ct65545move(VGAscr* scr, Point p)
106 
{
107 
	int index, x, xo, y, yo;
108 
 
109 
	index = 0;
110 
	if((x = p.x+scr->offset.x) < 0){
111 
		xo = -x;
112 
		x = 0;
113 
	}
114 
	else
115 
		xo = 0;
116 
	if((y = p.y+scr->offset.y) < 0){
117 
		yo = -y;
118 
		y = 0;
119 
	}
120 
	else
121 
		yo = 0;
122 
 
123 
	if(xo || yo){
124 
		ct65545initcursor(scr, xo, yo, 1);
125 
		index = 1;
126 
	}
127 
	outl(0xB3D0, scr->storage + index*1024);
128 
 
129 
	outl(0xAFD0, (y<<16)|x);
130 
 
131 
	return 0;
132 
}
133 
 
134 
VGAdev vgact65545dev = {
135 
	"ct65540",				/* BUG: really 65545 */
136 
 
137 
	0,
138 
	0,
139 
	ct65545page,
140 
	0,
141 
};
142 
 
143 
VGAcur vgact65545cur = {
144 
	"ct65545hwgc",
145 
 
146 
	ct65545enable,
147 
	ct65545disable,
148 
	ct65545load,
149 
	ct65545move,
150 
};