#include <ctype.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#define TERASGN(a, b, c, d) (a) ? (b = d) : (c = d)
enum {THM, AABB};
int colltype = -1;
int postype = -1;
int verbose = 0;
const char *opts = "c:v:h";
struct pos {
int x;
int y;
int z;
double fx;
double fy;
double fz;
};
struct colis {
int w;
int h;
double xvel;
double yvel;
struct pos pos;
int a1;
int a2;
int b1;
int b2;
double c1;
double c2;
double d1;
double d2;
uint8_t *heightmap;
unsigned int clx : 1;
unsigned int cly : 1;
unsigned int gnded : 1;
unsigned int flp : 1;
};
static int usage() {
printf(
"clld Version MFIYA.\n"
"Usage: clld [options]\n"
"Options:\n"
" -c[type] Force the collision type to be\n"
" the specified type (THM=0, AABB=1).\n"
" -v[level] Sets the verbosity level (0-3).\n"
" -h What do you fucking think it does.\n"
" Anyways, it brings up this cool help\n"
" message.\n"
);
return 0;
}
uint8_t isleft = 0;
uint8_t isright = 0;
uint8_t istop = 0;
uint8_t isbottom = 0;
uint8_t isinfloor_x = 0;
uint8_t isinfloor_y = 0;
uint8_t get_coldir(uint8_t flt, uint8_t col_type, int hmpeak, struct colis *cursor, struct colis *floor) {
uint8_t coldir = 0;
uint8_t isinfloor_left = 0;
uint8_t isinfloor_right = 0;
uint8_t isinfloor_top = 0;
uint8_t isinfloor_bottom = 0;
switch (col_type) {
case AABB:
if (flt) {
isleft = cursor->c2 > floor->c1-cursor->xvel-1;
isright = cursor->c1 < floor->c2-cursor->xvel+1;
istop = cursor->d2 > floor->d1-cursor->yvel-1;
isbottom = cursor->d1 < floor->d2-cursor->yvel+1;
isinfloor_left = cursor->d2 > floor->d1;
isinfloor_right = cursor->d1 < floor->d2;
isinfloor_top = cursor->c2 > floor->c1;
isinfloor_bottom = cursor->c1 < floor->c2;
} else {
isleft = cursor->a2 > floor->a1-cursor->xvel-1;
isright = cursor->a1 < floor->a2-cursor->xvel+1;
istop = cursor->b2 > floor->b1-cursor->yvel-1;
isbottom = cursor->b1 < floor->b2-cursor->yvel+1;
isinfloor_left = cursor->b2 > floor->b1;
isinfloor_right = cursor->b1 < floor->b2;
isinfloor_top = cursor->a2 > floor->a1;
isinfloor_bottom = cursor->a1 < floor->a2;
}
isinfloor_x = isinfloor_left && isinfloor_right ;
isinfloor_y = isinfloor_top && isinfloor_bottom;
break;
case THM:
if (flt) {
isleft = cursor->c2 > floor->c1-cursor->xvel-1;
isright = cursor->c1 < (floor->c2-cursor->w)-cursor->xvel+1;
if (!floor->flp) {
istop = cursor->d2 > (floor->d2-hmpeak)-cursor->yvel;
isbottom = cursor->d1 < floor->d2-cursor->yvel+1;
isinfloor_left = floor->d2-cursor->d2 < floor->heightmap[0] && cursor->xvel > 0;
isinfloor_right = floor->d2-cursor->d2 < floor->heightmap[floor->w-1] && cursor->xvel < 0;
isinfloor_top = floor->d2-cursor->d2 >= 0;
isinfloor_bottom = floor->d2-cursor->d1 <= 0;
} else {
istop = cursor->d2 > floor->d1-cursor->yvel-1;
isbottom = cursor->d1 < (floor->d1+hmpeak)-cursor->yvel;
isinfloor_left = floor->d1-cursor->d1 > -floor->heightmap[0] && cursor->xvel > 0;
isinfloor_right = floor->d1-cursor->d1 > -floor->heightmap[floor->w-1] && cursor->xvel < 0;
isinfloor_top = floor->d1-cursor->d2 >= 0 && cursor->yvel > 0;
isinfloor_bottom = cursor->d1-floor->d1 >= 0;
}
} else {
isleft = cursor->a2 > floor->a1-cursor->xvel-1;
isright = cursor->a1 < (floor->a2-cursor->w)-cursor->xvel+1;
if (!floor->flp) {
istop = cursor->b2 > (floor->b2-hmpeak)-cursor->yvel;
isbottom = cursor->b1 < floor->b2-cursor->yvel+1;
isinfloor_left = floor->b2-cursor->b2 < floor->heightmap[0];
isinfloor_right = floor->b2-cursor->b2 < floor->heightmap[floor->w-1];
isinfloor_top = floor->b2-cursor->b2 >= 0;
isinfloor_bottom = floor->b2-cursor->b1 <= 0;
} else {
istop = cursor->b2 > floor->b1-cursor->yvel-1;
isbottom = cursor->b1 < (floor->b1+hmpeak)-cursor->yvel;
isinfloor_left = floor->b1-cursor->b1 > -floor->heightmap[0];
isinfloor_right = floor->b1-cursor->b1 > -floor->heightmap[floor->w-1];
isinfloor_top = floor->b1-cursor->b2 >= 0 && cursor->yvel > 0;
isinfloor_bottom = cursor->b1-floor->b1 >= 0;
}
}
isinfloor_x = isinfloor_left ^ isinfloor_right ;
isinfloor_y = isinfloor_top ^ isinfloor_bottom;
break;
}
if (isinfloor_x) {
coldir |= isleft << 0;
coldir |= isright << 1;
}
if (isinfloor_y) {
coldir |= istop << 2;
coldir |= isbottom << 3;
}
return coldir;
}
int thm(int hmpeak, struct colis *cursor, struct colis *floor) {
int newy = 0;
cursor->clx = (cursor->a2 > floor->a1-cursor->xvel-1 && cursor->b2 > floor->b1) && (cursor->a1 < (floor->a2-cursor->w)-cursor->xvel+1 && cursor->b1 < floor->b2);
cursor->cly = (cursor->b2 >= floor->b1-cursor->yvel && cursor->a2 >= floor->a1) && (cursor->b1 <= floor->b2-cursor->yvel && cursor->a1 <= floor->a2);
uint8_t coldir = get_coldir(0, THM, hmpeak, cursor, floor);
if (cursor->clx && (cursor->a2-floor->a1 < 0 || cursor->a2-floor->a1 > floor->w)) {
switch (coldir & 3) {
case 1: cursor->pos.x = (floor->pos.x-cursor->xvel)-cursor->w-1; break;
case 2: cursor->pos.x = (floor->a2-cursor->w)-cursor->xvel+1; break;
}
cursor->xvel = 0;
floor->xvel = 0;
}
if (cursor->cly && cursor->a2-floor->a1 < floor->w) {
newy = floor->heightmap[cursor->a2-floor->a1];
switch (coldir & 12) {
case 4:
if (!floor->flp) {
cursor->pos.y = ((floor->b2-cursor->h)-newy)-cursor->yvel;
} else {
cursor->pos.y = (floor->pos.y-cursor->h)-cursor->yvel;
}
break;
case 8:
if (!floor->flp) {
cursor->pos.y = (floor->pos.y+floor->h)-cursor->yvel+1;
} else {
cursor->pos.y = (floor->pos.y+newy)-cursor->yvel;
}
break;
}
cursor->yvel = 0;
floor->yvel = 0;
}
cursor->gnded = (cursor->pos.y == ((floor->b2-cursor->h)-newy)-cursor->yvel);
printf("%u, %u\n%u\n%i\n%i, %i\n%07.06f, %07.06f\n", cursor->clx, cursor->cly, cursor->gnded, newy, cursor->pos.x, cursor->pos.y, cursor->xvel, cursor->yvel);
printf("%u, %u\n%u\n%i\n%i, %i\n%07.06f, %07.06f\n", floor->clx, floor->cly, floor->gnded, newy, floor->pos.x, floor->pos.y, floor->xvel, floor->yvel);
return 0;
}
int fthm(int hmpeak, struct colis *cursor, struct colis *floor) {
int newy = 0;
cursor->clx = (cursor->c2 > floor->c1-cursor->xvel-1 && cursor->d2 > floor->d1) && (cursor->c1 < (floor->c2-cursor->w)-cursor->xvel+1 && cursor->d1 < floor->d2);
cursor->cly = (cursor->d2 >= floor->d1-cursor->yvel && cursor->c2 >= floor->c1) && (cursor->d1 <= floor->d2-cursor->yvel && cursor->c1 <= floor->c2);
uint8_t coldir = get_coldir(1, THM, hmpeak, cursor, floor);
if (cursor->clx && cursor->c2-floor->c1 < -1 || cursor->c2-floor->c1 > floor->w) {
switch (coldir & 3) {
case 1: cursor->pos.fx = (floor->pos.fx-cursor->xvel)-cursor->w-1; break;
case 2: cursor->pos.fx = (floor->c2-cursor->w)-cursor->xvel+1; break;
}
cursor->xvel = 0;
cursor->xvel = 0;
}
if (cursor->cly && cursor->c2-floor->c1 < floor->w) {
newy = floor->heightmap[(int)cursor->c2-(int)floor->c1];
switch (coldir & 12) {
case 4:
if (!floor->flp) {
cursor->pos.fy = ((floor->d2-cursor->h)-newy)-cursor->yvel;
} else {
cursor->pos.fy = (floor->pos.fy-cursor->h)-cursor->yvel;
}
break;
case 8:
if (!floor->flp) {
cursor->pos.fy = (floor->pos.fy+floor->h)-cursor->yvel;
} else {
cursor->pos.fy = (floor->pos.fy+newy)-cursor->yvel;
}
break;
}
cursor->yvel = 0;
floor->yvel = 0;
}
cursor->gnded = (cursor->pos.fy == ((floor->d2-cursor->h)-newy)-cursor->yvel);
printf("%u, %u\n%u\n%i\n%07.06f, %07.06f\n%07.06f, %07.06f\n", cursor->clx, cursor->cly, cursor->gnded, newy, cursor->pos.fx, cursor->pos.fy, cursor->xvel, cursor->yvel);
printf("%u, %u\n%u\n%i\n%07.06f, %07.06f\n%07.06f, %07.06f\n", floor->clx, floor->cly, floor->gnded, newy, floor->pos.fx, floor->pos.fy, floor->xvel, floor->yvel);
return 0;
}
int aabb(struct colis *cursor, struct colis *floor) {
uint8_t coldir = get_coldir(0, AABB, -1, cursor, floor);
uint8_t left = (cursor->xvel > 0) && (!floor->xvel || floor->xvel != 0);
uint8_t right = (cursor->xvel < 0) && (!floor->xvel || floor->xvel != 0);
uint8_t top = (cursor->yvel > 0) && (!floor->yvel || floor->yvel != 0);
uint8_t bottom = (cursor->yvel < 0) && (!floor->yvel || floor->yvel != 0);
cursor->clx = (coldir & 0x03) == 0x03;
cursor->cly = (coldir & 0x0C) == 0x0C;
cursor->gnded = (cursor->b2 == floor->b1-cursor->yvel-1);
if (cursor->clx) {
if (left) {
cursor->pos.x = (floor->pos.x-cursor->xvel)-cursor->w-1;
} else if (!left && floor->xvel != 0) {
if (!right && floor->xvel < 0) {
cursor->pos.x = (floor->pos.x-cursor->xvel)-cursor->w-1;
}
}
if (right) {
cursor->pos.x = (floor->pos.x+floor->w)-cursor->xvel+1;
} else if (!right && floor->xvel != 0) {
if (!left && floor->xvel > 0) {
cursor->pos.x = (floor->pos.x+floor->w)-cursor->xvel+1;
}
}
cursor->xvel = 0;
floor->xvel = 0;
}
if (cursor->cly) {
if (top) {
cursor->pos.y = (floor->pos.y-cursor->yvel)-cursor->h-1;
} else if (!top && floor->yvel != 0) {
if (!bottom && floor->yvel < 0) {
cursor->pos.y = (floor->pos.y-cursor->yvel)-cursor->h-1;
}
}
if (bottom) {
cursor->pos.y = (floor->pos.y+floor->h)-cursor->yvel+1;
} else if (!bottom && floor->yvel != 0) {
if (!top && floor->yvel > 0) {
cursor->pos.y = (floor->pos.y+floor->h)-cursor->yvel+1;
}
}
cursor->yvel = 0;
floor->yvel = 0;
}
printf("%u, %u\n%u\n%i, %i\n%07.06f, %07.06f\n", cursor->clx, cursor->cly, cursor->gnded, cursor->pos.x, cursor->pos.y, cursor->xvel, cursor->yvel);
printf("%u, %u\n%u\n%i, %i\n%07.06f, %07.06f\n", floor->clx, floor->cly, floor->gnded, floor->pos.x, floor->pos.y, floor->xvel, floor->yvel);
return 0;
}
int faabb(struct colis *cursor, struct colis *floor) {
uint8_t coldir = get_coldir(1, AABB, -1, cursor, floor);
uint8_t left = (cursor->xvel > 0) && (!floor->xvel || floor->xvel != 0);
uint8_t right = (cursor->xvel < 0) && (!floor->xvel || floor->xvel != 0);
uint8_t top = (cursor->yvel > 0) && (!floor->yvel || floor->yvel != 0);
uint8_t bottom = (cursor->yvel < 0) && (!floor->yvel || floor->yvel != 0);
cursor->clx = (coldir & 0x03) == 0x03;
cursor->cly = (coldir & 0x0C) == 0x0C;
cursor->gnded = (cursor->d2 == floor->d1-cursor->yvel-1);
if (cursor->clx) {
if (left) {
cursor->pos.fx = (floor->pos.fx-cursor->xvel)-cursor->w-1;
} else if (!left && floor->xvel != 0) {
if (!right && floor->xvel < 0) {
cursor->pos.fx = (floor->pos.fx-cursor->xvel)-cursor->w-1;
}
}
if (right) {
cursor->pos.fx = (floor->pos.fx+floor->w)-cursor->xvel+1;
} else if (!right && floor->xvel != 0) {
if (!left && floor->xvel > 0) {
cursor->pos.fx = (floor->pos.fx+floor->w)-cursor->xvel+1;
}
}
cursor->xvel = 0;
floor->xvel = 0;
}
if (cursor->cly) {
if (top) {
cursor->pos.fy = (floor->pos.fy-cursor->yvel)-cursor->h-1;
} else if (!top && floor->yvel != 0) {
if (!bottom && floor->yvel < 0) {
cursor->pos.fy = (floor->pos.fy-cursor->yvel)-cursor->h-1;
}
}
if (bottom) {
cursor->pos.fy = (floor->pos.fy+floor->h)-cursor->yvel+1;
} else if (!bottom && floor->yvel != 0) {
if (!top && floor->yvel > 0) {
cursor->pos.fy = (floor->pos.fy+floor->h)-cursor->yvel+1;
}
}
cursor->yvel = 0;
floor->yvel = 0;
}
printf("%u, %u\n%u\n%07.06f, %07.06f\n%07.06f, %07.06f\n", cursor->clx, cursor->cly, cursor->gnded, cursor->pos.fx, cursor->pos.fy, cursor->xvel, cursor->yvel);
printf("%u, %u\n%u\n%07.06f, %07.06f\n%07.06f, %07.06f\n", floor->clx, floor->cly, floor->gnded, floor->pos.fx, floor->pos.fy, floor->xvel, floor->yvel);
return 0;
}
int main(int argc, char **argv) {
int c;
FILE *fp = NULL;
uint8_t isfile = 0;
opterr = 0;
while (optind < argc) {
if ((c = getopt(argc, argv, opts)) != -1) {
switch(c) {
case 'c':
colltype = atoi(optarg);
break;
case 'v':
verbose = atoi(optarg);
break;
case 'h':
usage();
return 2;
case '?':
if (isprint(optopt)) {
if (optopt == 'c') {
fprintf(stderr, "Setting colltype to default.\n");
colltype = -1;
break;
} else if (optopt == 'v') {
fprintf(stderr, "Enabling single level verbosity.\n");
verbose = 1;
break;
} else {
fprintf(stderr
, "The option that you have typed in, which in this case\n"
"is -%c, does not exist.\n"
"Try looking at the help message, or RTFM, next time.\n"
, optopt);
}
} else {
fprintf(stderr
, "What the fuck are you trying to type in, a binary blob?\n"
"Because of this, clld will exit, so, stop acting like a\n"
"jackass.\n");
}
return -1;
default: ;
}
} else {
if (!isfile) {
fp = fopen(argv[optind], "r");
if (fp == NULL) {
fprintf(stderr, "Failed to open file %s\n", optarg);
return -1;
}
}
isfile = (fp != NULL);
optind++;
}
}
struct colis cursor;
struct colis floor;
struct colis tmp;
int hmpeak = 0;
char *buf = NULL;
size_t size;
getline(&buf, &size, (isfile) ? fp : stdin);
if (colltype == -1)
colltype = atoi(strtok(buf, "\n"));
for (int coll = 0; coll <= 1; coll++) {
buf = NULL;
getline(&buf, &size, (isfile) ? fp : stdin);
tmp.w = atoi(strtok(buf, ","));
tmp.h = atoi(strtok(NULL, "\n"));
if (colltype == THM && coll)
tmp.heightmap = malloc(sizeof(uint8_t *)*tmp.w);
if (colltype == THM && coll) {
buf = NULL;
getline(&buf, &size, (isfile) ? fp : stdin);
floor.flp = buf[0] - '0';
buf = NULL;
size_t newidth = getline(&buf, &size, (isfile) ? fp : stdin);
tmp.w = (newidth >= tmp.w) ? tmp.w : newidth;
for (unsigned int i = 0; i <tmp.w; i++) {
char *tmptok = strtok((i == 0) ? buf : NULL,",");
tmptok = (tmptok == NULL) ? strtok(NULL,"\n") : tmptok;
tmp.heightmap[i] = (uint8_t)((atoi(tmptok) <= tmp.h) ? atoi(tmptok) : tmp.h);
hmpeak = (atoi(tmptok)+1 >= hmpeak) ? atoi(tmptok)+1 : hmpeak;
}
}
(coll) ? (floor.w = tmp.w) : (cursor.w = tmp.w);
(coll) ? (floor.h = tmp.h) : (cursor.h = tmp.h);
if (coll)
floor.heightmap = tmp.heightmap;
if (verbose >= 1) {
if (colltype == THM && coll)
for (unsigned int i = 0; i<floor.h; i++)
printf((i < floor.h-1 && i % 16 != 0 || i == 0) ? "%u, " : ("%u\n"), floor.heightmap[i]);
}
uint8_t delms = 0;
char *tmp2;
buf = NULL;
getline(&buf, &size, (isfile) ? fp : stdin);
for (int j = 0; buf[j] != '\0'; j++)
if (buf[j] == ',')
delms++;
postype = (delms == 2) ? 1 : 0;
uint8_t flt;
flt = (strchr(buf, '.') != NULL) ? 1 : 0;
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);
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)
tmp.pos.y = atoi(strtok(NULL,","));
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);
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);
}
}
buf = NULL;
getline(&buf, &size, (isfile) ? fp : stdin);
if (!coll) {
cursor.xvel = atof(strtok(buf, ","));
cursor.yvel = atof(strtok(NULL, "\n"));
} else {
floor.xvel = atof(strtok(buf, ","));
floor.yvel = atof(strtok(NULL, "\n"));
}
(!flt) ? (cursor.a1 = cursor.pos.x) : (cursor.c1 = cursor.pos.fx);
(!flt) ? (cursor.a2 = cursor.pos.x+cursor.w) : (cursor.c2 = cursor.pos.fx+cursor.w);
(!flt) ? (cursor.b1 = cursor.pos.y) : (cursor.d1 = cursor.pos.fy);
(!flt) ? (cursor.b2 = cursor.pos.y+cursor.h) : (cursor.d2 = cursor.pos.fy+cursor.h);
(!flt) ? (floor.a1 = floor.pos.x) : (floor.c1 = floor.pos.fx);
(!flt) ? (floor.a2 = floor.pos.x+floor.w) : (floor.c2 = floor.pos.fx+floor.w);
(!flt) ? (floor.b1 = floor.pos.y) : (floor.d1 = floor.pos.fy);
(!flt) ? (floor.b2 = floor.pos.y+floor.h) : (floor.d2 = floor.pos.fy+floor.h);
if (coll) {
switch (colltype) {
case THM : (!flt) ? thm(hmpeak, &cursor, &floor) : fthm(hmpeak, &cursor, &floor); break;
case AABB: (!flt) ? aabb(&cursor, &floor ) : faabb(&cursor, &floor ); break;
}
}
}
uint8_t a = 0;
unsigned int i = 0;
free(buf);
if(colltype == THM) {
free(floor.heightmap);
}
fflush(stdout);
return 0;
}