void update_grav(void) { int x, y, i, j, changed = 0; float val, distance; th_gravchanged = 0; #ifndef GRAV_DIFF //Find any changed cells for (i=0; i<YRES/CELL; i++) { if(changed) break; for (j=0; j<XRES/CELL; j++) { if(th_ogravmap[i*(XRES/CELL)+j]!=th_gravmap[i*(XRES/CELL)+j]){ changed = 1; break; } } } if(!changed) goto fin; memset(th_gravy, 0, (XRES/CELL)*(YRES/CELL)*sizeof(float)); memset(th_gravx, 0, (XRES/CELL)*(YRES/CELL)*sizeof(float)); #endif th_gravchanged = 1; for (i = 0; i < YRES / CELL; i++) { for (j = 0; j < XRES / CELL; j++) { #ifdef GRAV_DIFF if (th_ogravmap[i*(XRES/CELL)+j] != th_gravmap[i*(XRES/CELL)+j]) { #else if (th_gravmap[i*(XRES/CELL)+j] > 0.0001f || th_gravmap[i*(XRES/CELL)+j]<-0.0001f) //Only calculate with populated or changed cells. { #endif for (y = 0; y < YRES / CELL; y++) { for (x = 0; x < XRES / CELL; x++) { if (x == j && y == i)//Ensure it doesn't calculate with itself continue; distance = sqrt(pow(j - x, 2) + pow(i - y, 2)); #ifdef GRAV_DIFF val = th_gravmap[i*(XRES/CELL)+j] - th_ogravmap[i*(XRES/CELL)+j]; #else val = th_gravmap[i*(XRES/CELL)+j]; #endif th_gravx[y*(XRES/CELL)+x] += M_GRAV * val * (j - x) / pow(distance, 3); th_gravy[y*(XRES/CELL)+x] += M_GRAV * val * (i - y) / pow(distance, 3); th_gravp[y*(XRES/CELL)+x] += M_GRAV * val / pow(distance, 2); } } } } } fin: memcpy(th_ogravmap, th_gravmap, (XRES/CELL)*(YRES/CELL)*sizeof(float)); } #endif void grav_mask_r(int x, int y, char checkmap[YRES/CELL][XRES/CELL], char shape[YRES/CELL][XRES/CELL], char *shapeout) { if(x < 0 || x >= XRES/CELL || y < 0 || y >= YRES/CELL) return; if(x == 0 || y ==0 || y == (YRES/CELL)-1 || x == (XRES/CELL)-1) *shapeout = 1; checkmap[y][x] = 1; shape[y][x] = 1; if(x-1 >= 0 && !checkmap[y][x-1] && globalSim->walls.type(SimPosCell(x-1,y))!=WL_GRAV) grav_mask_r(x-1, y, checkmap, shape, shapeout); if(y-1 >= 0 && !checkmap[y-1][x] && globalSim->walls.type(SimPosCell(x,y-1))!=WL_GRAV) grav_mask_r(x, y-1, checkmap, shape, shapeout); if(x+1 < XRES/CELL && !checkmap[y][x+1] && globalSim->walls.type(SimPosCell(x+1,y))!=WL_GRAV) grav_mask_r(x+1, y, checkmap, shape, shapeout); if(y+1 < YRES/CELL && !checkmap[y+1][x] && globalSim->walls.type(SimPosCell(x,y+1))!=WL_GRAV) grav_mask_r(x, y+1, checkmap, shape, shapeout); return; } struct mask_el; typedef struct mask_el mask_el; struct mask_el { char *shape; char shapeout; mask_el *next; }; void mask_free(mask_el *c_mask_el){ if(c_mask_el==NULL) return; if(c_mask_el->next!=NULL) mask_free(c_mask_el->next); free(c_mask_el->shape); free(c_mask_el); } void gravity_mask() { char checkmap[YRES/CELL][XRES/CELL]; int x = 0, y = 0; unsigned maskvalue; mask_el *t_mask_el = NULL; mask_el *c_mask_el = NULL; if(!gravmask) return; memset(checkmap, 0, sizeof(checkmap)); for(x = 0; x < XRES/CELL; x++) { for(y = 0; y < YRES/CELL; y++) { if(globalSim->walls.type(SimPosCell(x,y))!=WL_GRAV && checkmap[y][x] == 0) { //Create a new shape if(t_mask_el==NULL){ t_mask_el = (mask_el*)malloc(sizeof(mask_el)); t_mask_el->shape = (char*)malloc((XRES/CELL)*(YRES/CELL)); memset(t_mask_el->shape, 0, (XRES/CELL)*(YRES/CELL)); t_mask_el->shapeout = 0; t_mask_el->next = NULL; c_mask_el = t_mask_el; } else { c_mask_el->next = (mask_el*)malloc(sizeof(mask_el)); c_mask_el = c_mask_el->next; c_mask_el->shape = (char*)malloc((XRES/CELL)*(YRES/CELL)); memset(c_mask_el->shape, 0, (XRES/CELL)*(YRES/CELL)); c_mask_el->shapeout = 0; c_mask_el->next = NULL; } //Fill the shape grav_mask_r(x, y, checkmap, (char(*)[XRES/CELL])c_mask_el->shape, &c_mask_el->shapeout); } } } c_mask_el = t_mask_el; memset(gravmask, 0, (XRES/CELL)*(YRES/CELL)*sizeof(unsigned)); while(c_mask_el!=NULL) { char *cshape = c_mask_el->shape; for(x = 0; x < XRES/CELL; x++) { for(y = 0; y < YRES/CELL; y++) { if(cshape[y*(XRES/CELL)+x]){ if(c_mask_el->shapeout) maskvalue = 0xFFFFFFFF; else maskvalue = 0x00000000; gravmask[y*(XRES/CELL)+x] = maskvalue; } } } c_mask_el = c_mask_el->next; } mask_free(t_mask_el); }
void Gravity::update_grav(void) { int x, y, i, j, changed = 0; float val, distance; th_gravchanged = 0; #ifndef GRAV_DIFF //Find any changed cells for (i=0; i<YRES/CELL; i++) { if(changed) break; for (j=0; j<XRES/CELL; j++) { if(th_ogravmap[i*(XRES/CELL)+j]!=th_gravmap[i*(XRES/CELL)+j]){ changed = 1; break; } } } if(!changed) goto fin; memset(th_gravy, 0, (XRES/CELL)*(YRES/CELL)*sizeof(float)); memset(th_gravx, 0, (XRES/CELL)*(YRES/CELL)*sizeof(float)); #endif th_gravchanged = 1; membwand(th_gravmap, gravmask, (XRES/CELL)*(YRES/CELL)*sizeof(float), (XRES/CELL)*(YRES/CELL)*sizeof(unsigned)); for (i = 0; i < YRES / CELL; i++) { for (j = 0; j < XRES / CELL; j++) { #ifdef GRAV_DIFF if (th_ogravmap[i*(XRES/CELL)+j] != th_gravmap[i*(XRES/CELL)+j]) { #else if (th_gravmap[i*(XRES/CELL)+j] > 0.0001f || th_gravmap[i*(XRES/CELL)+j]<-0.0001f) //Only calculate with populated or changed cells. { #endif for (y = 0; y < YRES / CELL; y++) { for (x = 0; x < XRES / CELL; x++) { if (x == j && y == i)//Ensure it doesn't calculate with itself continue; distance = sqrt(pow(j - x, 2.0f) + pow(i - y, 2.0f)); #ifdef GRAV_DIFF val = th_gravmap[i*(XRES/CELL)+j] - th_ogravmap[i*(XRES/CELL)+j]; #else val = th_gravmap[i*(XRES/CELL)+j]; #endif th_gravx[y*(XRES/CELL)+x] += M_GRAV * val * (j - x) / pow(distance, 3.0f); th_gravy[y*(XRES/CELL)+x] += M_GRAV * val * (i - y) / pow(distance, 3.0f); th_gravp[y*(XRES/CELL)+x] += M_GRAV * val / pow(distance, 2.0f); } } } } } fin: memcpy(th_ogravmap, th_gravmap, (XRES/CELL)*(YRES/CELL)*sizeof(float)); memcpy(obmap, bmap, (XRES/CELL)*(YRES/CELL)*sizeof(unsigned char)); } #endif void Gravity::grav_mask_r(int x, int y, char checkmap[YRES/CELL][XRES/CELL], char shape[YRES/CELL][XRES/CELL], char *shapeout) { if(x < 0 || x >= XRES/CELL || y < 0 || y >= YRES/CELL) return; if(x == 0 || y ==0 || y == (YRES/CELL)-1 || x == (XRES/CELL)-1) *shapeout = 1; int x1 = x, x2 = x; while (x1 >= 1) { if(checkmap[y][x1-1] || bmap[y][x1-1]==WL_GRAV) break; x1--; } while (x2 < (XRES/CELL)-1) { if(checkmap[y][x2+1] || bmap[y][x2+1]==WL_GRAV) break; x2++; } // fill span for (x = x1; x <= x2; x++) checkmap[y][x] = shape[y][x] = 1; if(y >= 1) for(x = x1; x <= x2; x++) if(!checkmap[y-1][x] && bmap[y-1][x]!=WL_GRAV) grav_mask_r(x, y-1, checkmap, shape, shapeout); if(y < (YRES/CELL)-1) for(x = x1; x <= x2; x++) if(!checkmap[y+1][x] && bmap[y+1][x]!=WL_GRAV) grav_mask_r(x, y+1, checkmap, shape, shapeout); return; } void Gravity::mask_free(mask_el *c_mask_el){ if(c_mask_el==NULL) return; if(c_mask_el->next!=NULL) mask_free((mask_el*)c_mask_el->next); free(c_mask_el->shape); free(c_mask_el); } void Gravity::gravity_mask() { char checkmap[YRES/CELL][XRES/CELL]; int x = 0, y = 0; unsigned maskvalue; mask_el *t_mask_el = NULL; mask_el *c_mask_el = NULL; if(!gravmask) return; memset(checkmap, 0, sizeof(checkmap)); for(x = 0; x < XRES/CELL; x++) { for(y = 0; y < YRES/CELL; y++) { if(bmap[y][x]!=WL_GRAV && checkmap[y][x] == 0) { //Create a new shape if(t_mask_el==NULL){ t_mask_el = (mask_el *)malloc(sizeof(mask_el)); t_mask_el->shape = (char *)malloc((XRES/CELL)*(YRES/CELL)); memset(t_mask_el->shape, 0, (XRES/CELL)*(YRES/CELL)); t_mask_el->shapeout = 0; t_mask_el->next = NULL; c_mask_el = t_mask_el; } else { c_mask_el->next = (mask_el *)malloc(sizeof(mask_el)); c_mask_el = (mask_el *)c_mask_el->next; c_mask_el->shape = (char *)malloc((XRES/CELL)*(YRES/CELL)); memset(c_mask_el->shape, 0, (XRES/CELL)*(YRES/CELL)); c_mask_el->shapeout = 0; c_mask_el->next = NULL; } //Fill the shape grav_mask_r(x, y, (char (*)[XRES/CELL])checkmap, (char (*)[XRES/CELL])c_mask_el->shape, (char*)&c_mask_el->shapeout); } } } c_mask_el = t_mask_el; memset(gravmask, 0, (XRES/CELL)*(YRES/CELL)*sizeof(unsigned)); while(c_mask_el!=NULL) { char *cshape = c_mask_el->shape; for(x = 0; x < XRES/CELL; x++) { for(y = 0; y < YRES/CELL; y++) { if(cshape[y*(XRES/CELL)+x]){ if(c_mask_el->shapeout) maskvalue = 0xFFFFFFFF; else maskvalue = 0x00000000; gravmask[y*(XRES/CELL)+x] = maskvalue; } } } c_mask_el = (mask_el*)c_mask_el->next; } mask_free(t_mask_el); }