jehanne/sys/src/lib/memdraw/load.c

82 lines
1.9 KiB
C

/*
* This file is part of the UCB release of Plan 9. It is subject to the license
* terms in the LICENSE file found in the top-level directory of this
* distribution and at http://akaros.cs.berkeley.edu/files/Plan9License. No
* part of the UCB release of Plan 9, including this file, may be copied,
* modified, propagated, or distributed except according to the terms contained
* in the LICENSE file.
*/
#include <u.h>
#include <libc.h>
#include <draw.h>
#include <memdraw.h>
int
loadmemimage(Memimage *i, Rectangle r, uint8_t *data, int ndata)
{
int y, l, lpart, rpart, mx, m, mr;
uint8_t *q;
if(!rectinrect(r, i->r))
return -1;
l = bytesperline(r, i->depth);
if(ndata < l*Dy(r))
return -1;
ndata = l*Dy(r);
q = byteaddr(i, r.min);
mx = 7/i->depth;
lpart = (r.min.x & mx) * i->depth;
rpart = (r.max.x & mx) * i->depth;
m = 0xFF >> lpart;
/* may need to do bit insertion on edges */
if(l == 1){ /* all in one byte */
if(rpart)
m ^= 0xFF >> rpart;
for(y=r.min.y; y<r.max.y; y++){
*q ^= (*data^*q) & m;
q += i->width*sizeof(uint32_t);
data++;
}
return ndata;
}
if(lpart==0 && rpart==0){ /* easy case */
for(y=r.min.y; y<r.max.y; y++){
jehanne_memmove(q, data, l);
q += i->width*sizeof(uint32_t);
data += l;
}
return ndata;
}
mr = 0xFF ^ (0xFF >> rpart);
if(lpart!=0 && rpart==0){
for(y=r.min.y; y<r.max.y; y++){
*q ^= (*data^*q) & m;
if(l > 1)
jehanne_memmove(q+1, data+1, l-1);
q += i->width*sizeof(uint32_t);
data += l;
}
return ndata;
}
if(lpart==0 && rpart!=0){
for(y=r.min.y; y<r.max.y; y++){
if(l > 1)
jehanne_memmove(q, data, l-1);
q[l-1] ^= (data[l-1]^q[l-1]) & mr;
q += i->width*sizeof(uint32_t);
data += l;
}
return ndata;
}
for(y=r.min.y; y<r.max.y; y++){
*q ^= (*data^*q) & m;
if(l > 2)
jehanne_memmove(q+1, data+1, l-2);
q[l-1] ^= (data[l-1]^q[l-1]) & mr;
q += i->width*sizeof(uint32_t);
data += l;
}
return ndata;
}