diff options
Diffstat (limited to 'clld.c')
-rw-r--r-- | clld.c | 141 |
1 files changed, 119 insertions, 22 deletions
@@ -52,8 +52,17 @@ int main(int argc, char **argv) { unsigned int w; unsigned int h; struct pos pos; + int a1; + int a2; + int b1; + int b2; + double c1; + double c2; + double d1; + double d2; uint8_t **bitmask; - unsigned int clds : 1; + unsigned int clx : 1; + unsigned int cly : 1; unsigned int gnded : 1; }; @@ -119,30 +128,32 @@ int main(int argc, char **argv) { tmp.h = (newheight >= tmp.h) ? tmp.h : newheight; for (unsigned int i = 0; i <tmp.h; i++) { char *tmptok = strtok((i == 0) ? buf : NULL,","); - if(atoi(tmptok) <= tmp.h) - tmp.bitmask[i] = (uint8_t *)atoi((tmptok == NULL ? strtok(NULL,"\n") : tmptok)); + tmptok = (tmptok == NULL) ? strtok(NULL,"\n") : tmptok; + tmp.bitmask[i] = (uint8_t *)((atoi(tmptok) <= tmp.h) ? atoi(tmptok) : tmp.h); } } + (coll) ? (floor.w = tmp.w) : (cursor.w = tmp.w); (coll) ? (floor.h = tmp.h) : (cursor.h = tmp.h); (coll) ? (floor.bitmask = tmp.bitmask) : (cursor.bitmask = tmp.bitmask); - - if (colltype == THM && coll) - for (unsigned int i = 0; i<floor.h; i++) - printf((i<floor.h-1) ? "%u, " : ("%u\n"), floor.bitmask[i]); + if (verbose >= 1) { + if (colltype == THM && coll) + for (unsigned int i = 0; i<floor.h; i++) + printf((i<floor.h-1) ? "%u, " : ("%u\n"), floor.bitmask[i]); - if (colltype == PPX) { - for (unsigned int j = 0; j<((coll) ? floor.h : cursor.h); j++) { - for (unsigned int i = 0; i<((coll) ? floor.w : cursor.w); i++) - if((coll) ? floor.bitmask[j][i] : cursor.bitmask[j][i]) - printf("%u", (coll) ? floor.bitmask[j][i] : cursor.bitmask[j][i]); - else - printf(" "); - printf("\n"); + if (colltype == PPX) { + for (unsigned int j = 0; j<((coll) ? floor.h : cursor.h); j++) { + for (unsigned int i = 0; i<((coll) ? floor.w : cursor.w); i++) + if((coll) ? floor.bitmask[j][i] : cursor.bitmask[j][i]) + printf("%u", (coll) ? floor.bitmask[j][i] : cursor.bitmask[j][i]); + else + printf(" "); + printf("\n"); + } } } @@ -156,16 +167,22 @@ int main(int argc, char **argv) { delms++; postype = (delms == 2) ? 1 : 0; /* Check for floating point coordinates. */ - if (strchr(buf, '.') != NULL) { + uint8_t flt; + flt = (strchr(buf, '.') != NULL) ? 1 : 0; + if (verbose >= 1) + printf("flt: %u\n", flt); + if (flt) { tmp.pos.fx = atof(strtok(buf,",")); if(postype) tmp.pos.fy = atof(strtok(NULL,",")); tmp2 = strtok(NULL, "\n"); TERASGN(postype, tmp.pos.fz, tmp.pos.fy, atof((tmp2 == NULL ? strtok(NULL,"\0") : tmp2))); (coll) ? (floor.pos = tmp.pos) : (cursor.pos = tmp.pos); - printf("%07.06f, %07.06f%s", (!coll) ? cursor.pos.fx : floor.pos.fx, (!coll) ? cursor.pos.fy : floor.pos.fy, (postype) ? ", " : "\n"); - if(postype) - printf("%07.06f\n", (!coll) ? cursor.pos.fz : floor.pos.fz); + if (verbose >= 1) { + printf("%07.06f, %07.06f%s", (!coll) ? cursor.pos.fx : floor.pos.fx, (!coll) ? cursor.pos.fy : floor.pos.fy, (postype) ? ", " : "\n"); + if(postype) + printf("%07.06f\n", (!coll) ? cursor.pos.fz : floor.pos.fz); + } } else { tmp.pos.x = atoi(strtok(buf,",")); if(postype) @@ -173,9 +190,89 @@ int main(int argc, char **argv) { tmp2 = strtok(NULL, "\n"); TERASGN(postype, tmp.pos.z, tmp.pos.y, atoi((tmp2 == NULL ? strtok(NULL,"\0") : tmp2))); (coll) ? (floor.pos = tmp.pos) : (cursor.pos = tmp.pos); - printf("%i, %i%s", (!coll) ? cursor.pos.x : floor.pos.x, (!coll) ? cursor.pos.y : floor.pos.y, (postype) ? ", " : "\n"); - if(postype) - printf("%i\n", (!coll) ? cursor.pos.z : floor.pos.z); + if (verbose >= 1) { + printf("%i, %i%s", (!coll) ? cursor.pos.x : floor.pos.x, (!coll) ? cursor.pos.y : floor.pos.y, (postype) ? ", " : "\n"); + if(postype) + printf("%i\n", (!coll) ? cursor.pos.z : floor.pos.z); + } + } + if (colltype == AABB && coll) { + if (!flt) { + cursor.a1 = cursor.pos.x; + cursor.a2 = cursor.pos.x+cursor.w; + cursor.b1 = cursor.pos.y; + cursor.b2 = cursor.pos.y+cursor.h; + floor.a1 = floor.pos.x; + floor.a2 = floor.pos.x+floor.w; + floor.b1 = floor.pos.y; + floor.b2 = floor.pos.y+floor.h; + + } else { + cursor.c1 = cursor.pos.fx; + cursor.c2 = cursor.pos.fx+cursor.w; + cursor.d1 = cursor.pos.fy; + cursor.d2 = cursor.pos.fy+cursor.h; + floor.c1 = floor.pos.fx; + floor.c2 = floor.pos.fx+floor.w; + floor.d1 = floor.pos.fy; + floor.d2 = floor.pos.fy+floor.h; + + } + if (!flt) { + cursor.gnded = (cursor.b2 == floor.b1) ? 1 : 0; + cursor.clx = ((cursor.a2 >= floor.a1 && cursor.a1 <= floor.a2) && (cursor.b1+(cursor.h/2) >= floor.b1 && cursor.b2-(cursor.h/2) <= floor.b2)) ? 1 : 0; + cursor.cly = ((cursor.b2 >= floor.b1 && cursor.b1 <= floor.b2) && (cursor.a1+(cursor.w/2) >= floor.a1 && cursor.a2-(cursor.w/2) <= floor.a2)) ? 1 : 0; + } else { + cursor.gnded = (cursor.d2 == floor.d1) ? 1 : 0; + cursor.clx = ((cursor.c2 >= floor.c1 && cursor.c1 <= floor.c2) && (cursor.d1+(cursor.h/2) >= floor.b1 && cursor.d1 <= floor.d2)) ? 1 : 0; + cursor.cly = ((cursor.d2 >= floor.d1 && cursor.d1 <= floor.d2) && (cursor.c1+(cursor.w/2) >= floor.c1 && cursor.c1 <= floor.c2)) ? 1 : 0; + } + + + + + if (verbose >= 1) + printf("cursor.pos.x: %i\ncursor.w: %u, cursor.h: %u\nfloor.pos.x: %i\nfloor.w: %u, floor.h: %u\n", cursor.pos.x, cursor.w, cursor.h, floor.pos.x, floor.w, floor.h); + if(!flt) { + if (cursor.clx) { + if (cursor.a2 >= floor.a1 && cursor.a2 < floor.a2) + cursor.pos.x = floor.pos.x-cursor.w; + else if (cursor.a1 <= floor.a2 && cursor.a1 > floor.a1) + cursor.pos.x = floor.pos.x+floor.w; + } + if (cursor.cly) { + if (cursor.b2 >= floor.b1 && cursor.b2 < floor.b2) + cursor.pos.y = floor.pos.y-cursor.h; + else if (cursor.b1 <= floor.b2 && cursor.b1 > floor.b1) + cursor.pos.y = floor.pos.y+floor.h; + } + if (verbose >= 1) { + printf("cursor.gnded: %u\nclx: %u, cly: %u\n", cursor.gnded, cursor.clx, cursor.cly); + printf("x: %i, y: %i\n", cursor.pos.x, cursor.pos.y); + printf("floor.x: %i, floor.y: %i\n", floor.pos.x, floor.pos.y); + } + printf("%u, %u\n%u\n%i, %i\n", cursor.clx, cursor.cly, cursor.gnded, cursor.pos.x, cursor.pos.y); + + } else { + if (cursor.clx) { + if (cursor.c2 >= floor.c1) + cursor.pos.fx = floor.pos.fx-cursor.w; + else if (cursor.c1 <= floor.c2) + cursor.pos.fx = floor.pos.fx+floor.w; + } + if (cursor.cly ) { + if (cursor.d2 >= floor.d1) + cursor.pos.fy = floor.pos.fy-cursor.h; + else if (cursor.d1 <= floor.d2) + cursor.pos.fy = floor.pos.fy+floor.h; + } + if (verbose >= 1) { + printf("cursor.gnded: %u\nclx: %u, cly: %u\n", cursor.gnded, cursor.clx, cursor.cly); + printf("fx: %07.06f, fy: %07.06f\n", cursor.pos.fx, cursor.pos.fy); + printf("floor.fx: %07.06f, floor.fy: %07.06f\n", floor.pos.fx, floor.pos.fy); + } + printf("%u, %u\n%u\n%07.06f, %07.06f\n", cursor.clx, cursor.cly, cursor.gnded, cursor.pos.fx, cursor.pos.fy); + } } } uint8_t a = 0; |