xref: /plan9/sys/src/cmd/unix/drawterm/libmemdraw/load.c (revision 8ccd4a6360d974db7bd7bbd4f37e7018419ea908)
1*8ccd4a63SDavid du Colombier #include <u.h>
2*8ccd4a63SDavid du Colombier #include <libc.h>
3*8ccd4a63SDavid du Colombier #include <draw.h>
4*8ccd4a63SDavid du Colombier #include <memdraw.h>
57dd7cddfSDavid du Colombier 
67dd7cddfSDavid du Colombier int
_loadmemimage(Memimage * i,Rectangle r,uchar * data,int ndata)77dd7cddfSDavid du Colombier _loadmemimage(Memimage *i, Rectangle r, uchar *data, int ndata)
87dd7cddfSDavid du Colombier {
97dd7cddfSDavid du Colombier 	int y, l, lpart, rpart, mx, m, mr;
107dd7cddfSDavid du Colombier 	uchar *q;
117dd7cddfSDavid du Colombier 
127dd7cddfSDavid du Colombier 	if(!rectinrect(r, i->r))
137dd7cddfSDavid du Colombier 		return -1;
147dd7cddfSDavid du Colombier 	l = bytesperline(r, i->depth);
157dd7cddfSDavid du Colombier 	if(ndata < l*Dy(r))
167dd7cddfSDavid du Colombier 		return -1;
177dd7cddfSDavid du Colombier 	ndata = l*Dy(r);
187dd7cddfSDavid du Colombier 	q = byteaddr(i, r.min);
197dd7cddfSDavid du Colombier 	mx = 7/i->depth;
207dd7cddfSDavid du Colombier 	lpart = (r.min.x & mx) * i->depth;
217dd7cddfSDavid du Colombier 	rpart = (r.max.x & mx) * i->depth;
227dd7cddfSDavid du Colombier 	m = 0xFF >> lpart;
237dd7cddfSDavid du Colombier 	/* may need to do bit insertion on edges */
247dd7cddfSDavid du Colombier 	if(l == 1){	/* all in one byte */
257dd7cddfSDavid du Colombier 		if(rpart)
267dd7cddfSDavid du Colombier 			m ^= 0xFF >> rpart;
277dd7cddfSDavid du Colombier 		for(y=r.min.y; y<r.max.y; y++){
287dd7cddfSDavid du Colombier 			*q ^= (*data^*q) & m;
297dd7cddfSDavid du Colombier 			q += i->width*sizeof(ulong);
307dd7cddfSDavid du Colombier 			data++;
317dd7cddfSDavid du Colombier 		}
327dd7cddfSDavid du Colombier 		return ndata;
337dd7cddfSDavid du Colombier 	}
347dd7cddfSDavid du Colombier 	if(lpart==0 && rpart==0){	/* easy case */
357dd7cddfSDavid du Colombier 		for(y=r.min.y; y<r.max.y; y++){
367dd7cddfSDavid du Colombier 			memmove(q, data, l);
377dd7cddfSDavid du Colombier 			q += i->width*sizeof(ulong);
387dd7cddfSDavid du Colombier 			data += l;
397dd7cddfSDavid du Colombier 		}
407dd7cddfSDavid du Colombier 		return ndata;
417dd7cddfSDavid du Colombier 	}
427dd7cddfSDavid du Colombier 	mr = 0xFF ^ (0xFF >> rpart);
437dd7cddfSDavid du Colombier 	if(lpart!=0 && rpart==0){
447dd7cddfSDavid du Colombier 		for(y=r.min.y; y<r.max.y; y++){
457dd7cddfSDavid du Colombier 			*q ^= (*data^*q) & m;
467dd7cddfSDavid du Colombier 			if(l > 1)
477dd7cddfSDavid du Colombier 				memmove(q+1, data+1, l-1);
487dd7cddfSDavid du Colombier 			q += i->width*sizeof(ulong);
497dd7cddfSDavid du Colombier 			data += l;
507dd7cddfSDavid du Colombier 		}
517dd7cddfSDavid du Colombier 		return ndata;
527dd7cddfSDavid du Colombier 	}
537dd7cddfSDavid du Colombier 	if(lpart==0 && rpart!=0){
547dd7cddfSDavid du Colombier 		for(y=r.min.y; y<r.max.y; y++){
557dd7cddfSDavid du Colombier 			if(l > 1)
567dd7cddfSDavid du Colombier 				memmove(q, data, l-1);
577dd7cddfSDavid du Colombier 			q[l-1] ^= (data[l-1]^q[l-1]) & mr;
587dd7cddfSDavid du Colombier 			q += i->width*sizeof(ulong);
597dd7cddfSDavid du Colombier 			data += l;
607dd7cddfSDavid du Colombier 		}
617dd7cddfSDavid du Colombier 		return ndata;
627dd7cddfSDavid du Colombier 	}
637dd7cddfSDavid du Colombier 	for(y=r.min.y; y<r.max.y; y++){
647dd7cddfSDavid du Colombier 		*q ^= (*data^*q) & m;
657dd7cddfSDavid du Colombier 		if(l > 2)
667dd7cddfSDavid du Colombier 			memmove(q+1, data+1, l-2);
677dd7cddfSDavid du Colombier 		q[l-1] ^= (data[l-1]^q[l-1]) & mr;
687dd7cddfSDavid du Colombier 		q += i->width*sizeof(ulong);
697dd7cddfSDavid du Colombier 		data += l;
707dd7cddfSDavid du Colombier 	}
717dd7cddfSDavid du Colombier 	return ndata;
727dd7cddfSDavid du Colombier }
73