1 76193d7c 2003-09-30 devnull #include <u.h>
 2 76193d7c 2003-09-30 devnull #include <libc.h>
 3 76193d7c 2003-09-30 devnull #include <draw.h>
 4 76193d7c 2003-09-30 devnull #include <memdraw.h>
 5 76193d7c 2003-09-30 devnull 
 6 76193d7c 2003-09-30 devnull int
 7 76193d7c 2003-09-30 devnull _loadmemimage(Memimage *i, Rectangle r, uchar *data, int ndata)
 8 76193d7c 2003-09-30 devnull {
 9 76193d7c 2003-09-30 devnull 	int y, l, lpart, rpart, mx, m, mr;
10 76193d7c 2003-09-30 devnull 	uchar *q;
11 76193d7c 2003-09-30 devnull 
12 76193d7c 2003-09-30 devnull 	if(!rectinrect(r, i->r))
13 76193d7c 2003-09-30 devnull 		return -1;
14 76193d7c 2003-09-30 devnull 	l = bytesperline(r, i->depth);
15 76193d7c 2003-09-30 devnull 	if(ndata < l*Dy(r))
16 76193d7c 2003-09-30 devnull 		return -1;
17 76193d7c 2003-09-30 devnull 	ndata = l*Dy(r);
18 76193d7c 2003-09-30 devnull 	q = byteaddr(i, r.min);
19 76193d7c 2003-09-30 devnull 	mx = 7/i->depth;
20 76193d7c 2003-09-30 devnull 	lpart = (r.min.x & mx) * i->depth;
21 76193d7c 2003-09-30 devnull 	rpart = (r.max.x & mx) * i->depth;
22 76193d7c 2003-09-30 devnull 	m = 0xFF >> lpart;
23 76193d7c 2003-09-30 devnull 	/* may need to do bit insertion on edges */
24 76193d7c 2003-09-30 devnull 	if(l == 1){	/* all in one byte */
25 76193d7c 2003-09-30 devnull 		if(rpart)
26 76193d7c 2003-09-30 devnull 			m ^= 0xFF >> rpart;
27 76193d7c 2003-09-30 devnull 		for(y=r.min.y; y<r.max.y; y++){
28 76193d7c 2003-09-30 devnull 			*q ^= (*data^*q) & m;
29 76193d7c 2003-09-30 devnull 			q += i->width*sizeof(u32int);
30 76193d7c 2003-09-30 devnull 			data++;
31 76193d7c 2003-09-30 devnull 		}
32 76193d7c 2003-09-30 devnull 		return ndata;
33 76193d7c 2003-09-30 devnull 	}
34 76193d7c 2003-09-30 devnull 	if(lpart==0 && rpart==0){	/* easy case */
35 76193d7c 2003-09-30 devnull 		for(y=r.min.y; y<r.max.y; y++){
36 76193d7c 2003-09-30 devnull 			memmove(q, data, l);
37 76193d7c 2003-09-30 devnull 			q += i->width*sizeof(u32int);
38 76193d7c 2003-09-30 devnull 			data += l;
39 76193d7c 2003-09-30 devnull 		}
40 76193d7c 2003-09-30 devnull 		return ndata;
41 76193d7c 2003-09-30 devnull 	}
42 76193d7c 2003-09-30 devnull 	mr = 0xFF ^ (0xFF >> rpart);
43 76193d7c 2003-09-30 devnull 	if(lpart!=0 && rpart==0){
44 76193d7c 2003-09-30 devnull 		for(y=r.min.y; y<r.max.y; y++){
45 76193d7c 2003-09-30 devnull 			*q ^= (*data^*q) & m;
46 76193d7c 2003-09-30 devnull 			if(l > 1)
47 76193d7c 2003-09-30 devnull 				memmove(q+1, data+1, l-1);
48 76193d7c 2003-09-30 devnull 			q += i->width*sizeof(u32int);
49 76193d7c 2003-09-30 devnull 			data += l;
50 76193d7c 2003-09-30 devnull 		}
51 76193d7c 2003-09-30 devnull 		return ndata;
52 76193d7c 2003-09-30 devnull 	}
53 76193d7c 2003-09-30 devnull 	if(lpart==0 && rpart!=0){
54 76193d7c 2003-09-30 devnull 		for(y=r.min.y; y<r.max.y; y++){
55 76193d7c 2003-09-30 devnull 			if(l > 1)
56 76193d7c 2003-09-30 devnull 				memmove(q, data, l-1);
57 76193d7c 2003-09-30 devnull 			q[l-1] ^= (data[l-1]^q[l-1]) & mr;
58 76193d7c 2003-09-30 devnull 			q += i->width*sizeof(u32int);
59 76193d7c 2003-09-30 devnull 			data += l;
60 76193d7c 2003-09-30 devnull 		}
61 76193d7c 2003-09-30 devnull 		return ndata;
62 76193d7c 2003-09-30 devnull 	}
63 76193d7c 2003-09-30 devnull 	for(y=r.min.y; y<r.max.y; y++){
64 76193d7c 2003-09-30 devnull 		*q ^= (*data^*q) & m;
65 76193d7c 2003-09-30 devnull 		if(l > 2)
66 76193d7c 2003-09-30 devnull 			memmove(q+1, data+1, l-2);
67 76193d7c 2003-09-30 devnull 		q[l-1] ^= (data[l-1]^q[l-1]) & mr;
68 76193d7c 2003-09-30 devnull 		q += i->width*sizeof(u32int);
69 76193d7c 2003-09-30 devnull 		data += l;
70 76193d7c 2003-09-30 devnull 	}
71 76193d7c 2003-09-30 devnull 	return ndata;
72 76193d7c 2003-09-30 devnull }