void
Add_bot_face(int pt1, int pt2, int pt3, fastf_t thick, int pos)
{
if ( pt1 == pt2 || pt2 == pt3 || pt1 == pt3 )
{
bu_log( "Add_bot_face: ignoring degenerate triangle in group %d component %d\n", group_id, comp_id );
return;
}
if ( pos == 0 ) /* use default */
pos = POS_FRONT;
if ( mode == PLATE_MODE )
{
if ( pos != POS_CENTER && pos != POS_FRONT )
{
bu_log( "Add_bot_face: illegal postion parameter (%d), must be one or two (ignoring face for group %d component %d)\n", pos, group_id, comp_id );
return;
}
}
if ( face_count >= face_size )
{
face_size += GRID_BLOCK;
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck() )
bu_log( "memory corrupted before realloc of faces, thickness, and facemode\n" );
faces = (int *)bu_realloc( (void *)faces, face_size*3*sizeof( int ), "faces" );
thickness = (fastf_t *)bu_realloc( (void *)thickness, face_size*sizeof( fastf_t ), "thickness" );
facemode = (char *)bu_realloc( (void *)facemode, face_size*sizeof( char ), "facemode" );
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck() )
bu_log( "memory corrupted after realloc of faces, thickness, and facemode\n" );
}
faces[face_count*3] = pt1;
faces[face_count*3+1] = pt2;
faces[face_count*3+2] = pt3;
if ( mode == PLATE_MODE )
{
thickness[face_count] = thick;
facemode[face_count] = pos;
}
else
{
thickness[face_count] = 0, 0;
facemode[face_count] = 0;
}
face_count++;
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck() )
bu_log( "memory corrupted at end of Add_bot_face()\n" );
}
void
do_grid(char *line)
{
int grid_no;
fastf_t x, y, z;
if ( RT_G_DEBUG&DEBUG_MEM_FULL && bu_mem_barriercheck() )
bu_log( "ERROR: bu_mem_barriercheck failed at start of do_grid\n" );
bu_strlcpy(field, &line[8], sizeof(field));
grid_no = atoi( field );
if ( grid_no < 1 )
{
bu_log( "ERROR: grid id number = %d\n", grid_no );
bu_bomb( "BAD GRID ID NUMBER\n" );
}
bu_strlcpy(field, &line[24], sizeof(field));
x = atof( field );
bu_strlcpy(field, &line[32], sizeof(field));
y = atof( field );
bu_strlcpy(field, &line[40], sizeof(field));
z = atof( field );
while ( grid_no > grid_size - 1 )
{
grid_size += GRID_BLOCK;
grid_pts = (point_t *)bu_realloc( (char *)grid_pts, grid_size * sizeof( point_t ), "fast4-g: grid_pts" );
}
VSET( grid_pts[grid_no], x*25.4, y*25.4, z*25.4 );
if ( grid_no > max_grid_no )
max_grid_no = grid_no;
if ( RT_G_DEBUG&DEBUG_MEM_FULL && bu_mem_barriercheck() )
bu_log( "ERROR: bu_mem_barriercheck failed at end of do_grid\n" );
}
static void
Convert_assy(char *line)
{
struct wmember head;
struct wmember *wmem = NULL;
char line1[MAX_LINE_SIZE];
char name[MAX_LINE_SIZE];
unsigned int obj;
char memb_name[MAX_LINE_SIZE];
unsigned int memb_obj;
char *brlcad_name = NULL;
float mat_col[4];
float junk;
int start;
int i;
if ( RT_G_DEBUG & DEBUG_MEM_FULL )
{
bu_log( "Barrier check at start of Convert_assy:\n" );
if ( bu_mem_barriercheck() )
bu_exit(EXIT_FAILURE, "Barrier check failed!!!\n" );
}
BU_LIST_INIT( &head.l );
start = (-1);
/* skip leading blanks */
while ( isspace( line[++start] ) && line[start] != '\0' );
if ( strncmp( &line[start], "assembly", 8 ) && strncmp( &line[start], "ASSEMBLY", 8 ) )
{
bu_log( "PROE-G: Convert_assy called for non-assembly:\n%s\n", line );
return;
}
/* skip blanks before name */
start += 7;
while ( isspace( line[++start] ) && line[start] != '\0' );
/* get name */
i = (-1);
start--;
while ( !isspace( line[++start] ) && line[start] != '\0' && line[start] != '\n' )
name[++i] = line[start];
name[++i] = '\0';
/* get object pointer */
sscanf( &line[start], "%x %f", &obj, &junk );
bu_log( "Converting Assembly: %s\n", name );
if ( debug )
bu_log( "Convert_assy: %s x%x\n", name, obj );
while ( bu_fgets( line1, MAX_LINE_SIZE, fd_in ) )
{
/* skip leading blanks */
start = (-1);
while ( isspace( line1[++start] ) && line[start] != '\0' );
if ( !strncmp( &line1[start], "endassembly", 11 ) || !strncmp( &line1[start], "ENDASSEMBLY", 11 ) )
{
brlcad_name = Get_unique_name( name, obj, ASSEMBLY_TYPE );
if ( debug )
{
struct wmember *wp;
bu_log( "\tmake assembly ( %s)\n", brlcad_name );
for ( BU_LIST_FOR( wp, wmember, &head.l ) )
bu_log( "\t%c %s\n", wp->wm_op, wp->wm_name );
}
else
bu_log( "\tUsing name: %s\n", brlcad_name );
mk_lcomb( fd_out, brlcad_name, &head, 0 ,
(char *)NULL, (char *)NULL, (unsigned char *)NULL, 0 );
break;
}
int
main( int argc, char *argv[] )
{
struct application *ap;
int c;
int verbose = 0;
int i, j;
int grid_size = 64;
fastf_t cell_size;
vect_t model_size;
vect_t xdir, zdir;
int job_count=0;
char **result_map = NULL;
struct bu_ptbl objs;
int my_session_id;
int do_plot=0;
struct timeval startTime;
struct timeval endTime;
double diff;
point_t mdl_min;
point_t mdl_max;
struct bu_vlb *vlb;
/* Things like bu_malloc() must have these initialized for use with parallel processing */
bu_semaphore_init( RT_SEM_LAST );
/* initialize the list of BRL-CAD objects to be raytraced (this is used for the "-o" option) */
bu_ptbl_init( &objs, 64, "objects" );
/* process command line args */
while ( (c=bu_getopt( argc, argv, "vps:o:" ) ) != -1 ) {
switch ( c ) {
case 'p': /* do print plot */
do_plot = 1;
break;
case 's': /* set the grid size (default is 64x64) */
grid_size = atoi( bu_optarg );
break;
case 'v': /* turn on verbose logging */
verbose = 1;
rts_set_verbosity( 1 );
break;
case 'o': /* add an object name to the list of BRL-CAD objects to raytrace */
bu_ptbl_ins( &objs, (long *)bu_optarg );
break;
default: /* ERROR */
bu_exit(1, usage, argv[0]);
}
}
if (bu_debug & BU_DEBUG_MEM_CHECK) {
bu_prmem("initial memory map");
bu_mem_barriercheck();
}
/* shoot a ray ten times, cleaning and loading geometry each time */
for(i=0 ; i<10 ; i++) {
/* load geometry */
my_session_id = loadGeometry( argv[bu_optind], &objs );
if ( my_session_id < 0 ) {
bu_exit(2, "Failed to load geometry from file (%s)\n", argv[bu_optind] );
}
get_model_extents( my_session_id, mdl_min, mdl_max );
VSET( xdir, 1, 0, 0 );
VSET( zdir, 0, 0, 1 );
VSUB2( model_size, mdl_max, mdl_min );
ap = NULL;
getApplication(&ap);
VJOIN2( ap->a_ray.r_pt, mdl_min,
model_size[Z]/2.0, zdir,
model_size[X]/2.0, xdir );
VSET( ap->a_ray.r_dir, 0, 1, 0 );
rts_shootray(ap);
vlb = (struct bu_vlb*)ap->a_uptr;
printHits(vlb);
freeApplication(ap);
/*rts_clean( my_session_id );*/
bu_log( "\n\n********* %d\n", i);
if (bu_debug & BU_DEBUG_MEM_CHECK) {
bu_prmem("memory after shutdown");
}
}
my_session_id = loadGeometry( argv[bu_optind], &objs );
/* submit some jobs */
fprintf( stderr, "\nfiring a grid (%dx%d) of rays at",
grid_size, grid_size );
for ( i=0; i<(int)BU_PTBL_LEN( &objs ); i++ ) {
fprintf( stderr, " %s", (char *)BU_PTBL_GET( &objs, i ) );
}
fprintf( stderr, "...\n" );
if( do_plot ) {
result_map = (char **)bu_calloc( grid_size, sizeof( char *), "result_map" );
for ( i=0; i<grid_size; i++ ) {
result_map[i] = (char *)bu_calloc( (grid_size+1), sizeof( char ), "result_map[i]" );
}
}
cell_size = model_size[X] / grid_size;
gettimeofday( &startTime, NULL );
for ( i=0; i<grid_size; i++ ) {
if( verbose ) {
fprintf( stderr, "shooting row %d\n", i );
}
for ( j=0; j<grid_size; j++ ) {
int hitCount;
getApplication(&ap);
ap->a_user = my_session_id;
VJOIN2( ap->a_ray.r_pt,
mdl_min,
i*cell_size,
zdir,
j*cell_size,
xdir );
ap->a_ray.index = ap->a_user;
VSET( ap->a_ray.r_dir, 0, 1, 0 );
rts_shootray(ap);
if( do_plot ) {
hitCount = countHits(ap->a_uptr);
if ( hitCount == 0 ) {
result_map[i][j] = ' ';
} else if ( hitCount <= 9 ) {
result_map[i][j] = '0' + hitCount;
} else {
result_map[i][j] = '*';
}
}
freeApplication(ap);
job_count++;
}
}
gettimeofday( &endTime, NULL );
diff = endTime.tv_sec - startTime.tv_sec + (endTime.tv_usec - startTime.tv_usec) / 1000000.0;
fprintf( stderr, "time for %d individual rays: %g second\n", job_count, diff );
if(do_plot) {
for ( i=grid_size-1; i>=0; i-- ) {
fprintf( stderr, "%s\n", result_map[i] );
}
}
return 0;
}
/**
* Apply a transformation matrix to the specified 'ip' input revolve
* object, storing the results in the specified 'op' out pointer or
* creating a copy if NULL.
*/
int
rt_revolve_xform(
struct rt_db_internal *op,
const mat_t mat,
struct rt_db_internal *ip,
int release,
struct db_i *dbip,
struct resource *resp)
{
struct rt_revolve_internal *rip, *rop;
point_t tmp_vec;
if (dbip) RT_CK_DBI(dbip);
RT_CK_DB_INTERNAL(ip);
RT_CK_RESOURCE(resp);
rip = (struct rt_revolve_internal *)ip->idb_ptr;
RT_REVOLVE_CK_MAGIC(rip);
if (bu_debug&BU_DEBUG_MEM_CHECK) {
bu_log("Barrier check at start of revolve_xform():\n");
bu_mem_barriercheck();
}
if (op != ip) {
RT_DB_INTERNAL_INIT(op);
BU_ALLOC(rop, struct rt_revolve_internal);
rop->magic = RT_REVOLVE_INTERNAL_MAGIC;
bu_vls_init(&rop->sketch_name);
bu_vls_vlscat(&rop->sketch_name, &rip->sketch_name);
op->idb_ptr = (void *)rop;
op->idb_meth = &OBJ[ID_REVOLVE];
op->idb_major_type = DB5_MAJORTYPE_BRLCAD;
op->idb_type = ID_REVOLVE;
if (ip->idb_avs.magic == BU_AVS_MAGIC) {
bu_avs_init(&op->idb_avs, ip->idb_avs.count, "avs");
bu_avs_merge(&op->idb_avs, &ip->idb_avs);
}
} else {
rop = (struct rt_revolve_internal *)ip->idb_ptr;
}
MAT4X3PNT(tmp_vec, mat, rip->v3d);
VMOVE(rop->v3d, tmp_vec);
MAT4X3VEC(tmp_vec, mat, rip->axis3d);
VMOVE(rop->axis3d, tmp_vec);
V2MOVE(rop->v2d, rip->v2d);
V2MOVE(rop->axis2d, rip->axis2d);
if (release && ip != op) {
rop->skt = rip->skt;
rip->skt = (struct rt_sketch_internal *)NULL;
rt_db_free_internal(ip);
} else if (rip->skt) {
rop->skt = rt_copy_sketch(rip->skt);
} else {
rop->skt = (struct rt_sketch_internal *)NULL;
}
if (bu_debug&BU_DEBUG_MEM_CHECK) {
bu_log("Barrier check at end of revolve_xform():\n");
bu_mem_barriercheck();
}
return 0;
}
void
Do_subfigs()
{
int i, j;
int entity_type;
struct wmember head1;
struct wmember *wmem;
if (RT_G_DEBUG & DEBUG_MEM_FULL)
bu_mem_barriercheck();
BU_LIST_INIT(&head1.l);
for (i = 0; i < totentities; i++) {
int subfigdef_de;
int subfigdef_index;
int no_of_members;
int *members;
char *name = NULL;
struct wmember head2;
double mat_scale[3];
int non_unit;
if (dir[i]->type != 408)
continue;
if (RT_G_DEBUG & DEBUG_MEM_FULL)
bu_mem_barriercheck();
if (dir[i]->param <= pstart) {
bu_log("Illegal parameter pointer for entity D%07d (%s)\n" ,
dir[i]->direct, dir[i]->name);
continue;
}
Readrec(dir[i]->param);
Readint(&entity_type, "");
if (entity_type != 408) {
bu_log("Expected Singular Subfigure Instance Entity, found %s\n",
iges_type(entity_type));
continue;
}
Readint(&subfigdef_de, "");
subfigdef_index = (subfigdef_de - 1)/2;
if (subfigdef_index >= totentities) {
bu_log("Singular Subfigure Instance Entity gives Subfigure Definition");
bu_log("\tEntity DE of %d, largest DE in file is %d\n",
subfigdef_de, (totentities * 2) - 1);
continue;
}
if (dir[subfigdef_index]->type != 308) {
bu_log("Expected Subfigure Definition Entity, found %s\n",
iges_type(dir[subfigdef_index]->type));
continue;
}
if (dir[subfigdef_index]->param <= pstart) {
bu_log("Illegal parameter pointer for entity D%07d (%s)\n" ,
dir[subfigdef_index]->direct, dir[subfigdef_index]->name);
continue;
}
Readrec(dir[subfigdef_index]->param);
Readint(&entity_type, "");
if (entity_type != 308) {
bu_log("Expected Subfigure Definition Entity, found %s\n",
iges_type(entity_type));
continue;
}
Readint(&j, ""); /* ignore depth */
Readstrg(""); /* ignore subfigure name */
wmem = mk_addmember(dir[subfigdef_index]->name, &head1.l, NULL, WMOP_UNION);
non_unit = 0;
for (j = 0; j < 3; j++) {
double mag_sq;
mat_scale[j] = 1.0;
mag_sq = MAGSQ(&(*dir[i]->rot)[j*4]);
/* FIXME: arbitrary undefined tolerance */
if (!NEAR_EQUAL(mag_sq, 1.0, 100.0*SQRT_SMALL_FASTF)) {
mat_scale[j] = 1.0/sqrt(mag_sq);
non_unit = 1;
}
}
if (non_unit) {
bu_log("Illegal transformation matrix in %s for member %s\n",
curr_file->obj_name, wmem->wm_name);
bu_log(" row vector magnitudes are %g, %g, and %g\n",
1.0/mat_scale[0], 1.0/mat_scale[1], 1.0/mat_scale[2]);
bn_mat_print("", *dir[i]->rot);
for (j = 0; j < 11; j++) {
if ((j+1)%4 == 0)
continue;
(*dir[i]->rot)[j] *= mat_scale[0];
}
bn_mat_print("After scaling:", *dir[i]->rot);
}
memcpy(wmem->wm_mat, *dir[i]->rot, sizeof(mat_t));
Readint(&no_of_members, ""); /* get number of members */
members = (int *)bu_calloc(no_of_members, sizeof(int), "Do_subfigs: members");
for (j = 0; j < no_of_members; j++)
Readint(&members[j], "");
BU_LIST_INIT(&head2.l);
for (j = 0; j < no_of_members; j++) {
int idx;
idx = (members[j] - 1)/2;
if (idx >= totentities) {
bu_log("Subfigure Definition Entity gives Member Entity");
bu_log("\tDE of %d, largest DE in file is %d\n",
members[j], (totentities * 2) - 1);
continue;
}
if (dir[idx]->param <= pstart) {
bu_log("Illegal parameter pointer for entity D%07d (%s)\n" ,
dir[idx]->direct, dir[idx]->name);
continue;
}
if (dir[idx]->type == 416) {
struct file_list *list_ptr;
char *file_name;
int found = 0;
/* external reference */
Readrec(dir[idx]->param);
Readint(&entity_type, "");
if (entity_type != 416) {
bu_log("Expected External reference Entity, found %s\n",
iges_type(entity_type));
continue;
}
if (dir[idx]->form != 1) {
bu_log("External Reference Entity of form #%d found\n",
dir[idx]->form);
bu_log("\tOnly form #1 is currently handled\n");
continue;
}
Readname(&file_name, "");
/* Check if this external reference is already on the list */
for (BU_LIST_FOR(list_ptr, file_list, &iges_list.l)) {
if (BU_STR_EQUAL(file_name, list_ptr->file_name)) {
found = 1;
name = list_ptr->obj_name;
break;
}
}
if (!found) {
/* Need to add this one to the list */
BU_ALLOC(list_ptr, struct file_list);
list_ptr->file_name = file_name;
if (no_of_members == 1)
bu_strlcpy(list_ptr->obj_name, dir[subfigdef_index]->name, NAMESIZE+1);
else {
bu_strlcpy(list_ptr->obj_name, "subfig", NAMESIZE+1);
(void) Make_unique_brl_name(list_ptr->obj_name);
}
BU_LIST_APPEND(&curr_file->l, &list_ptr->l);
name = list_ptr->obj_name;
} else
bu_free((char *)file_name, "Do_subfigs: file_name");
} else
name = dir[idx]->name;
if (no_of_members > 1) {
wmem = mk_addmember(name, &head2.l, NULL, WMOP_UNION);
memcpy(wmem->wm_mat, dir[idx]->rot, sizeof(mat_t));
}
}
if (no_of_members > 1)
(void)mk_lcomb(fdout, dir[subfigdef_index]->name, &head2, 0,
(char *)NULL, (char *)NULL, (unsigned char *)NULL, 0);
}
static void
do_tri(char *line)
{
int element_id;
int pt1, pt2, pt3;
fastf_t thick;
int pos;
if (debug)
bu_log("do_tri: %s\n", line);
bu_strlcpy(field, &line[8], sizeof(field));
element_id = atoi(field);
if (!bot)
bot = element_id;
if (faces == NULL) {
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck())
bu_log("memory corrupted before malloc of faces\n");
faces = (int *)bu_malloc(GRID_BLOCK*3*sizeof(int), "faces");
thickness = (fastf_t *)bu_malloc(GRID_BLOCK*sizeof(fastf_t), "thickness");
facemode = (char *)bu_malloc(GRID_BLOCK*sizeof(char), "facemode");
face_size = GRID_BLOCK;
face_count = 0;
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck())
bu_log("memory corrupted after malloc of faces, thickness, and facemode\n");
}
bu_strlcpy(field, &line[24], sizeof(field));
pt1 = atoi(field);
bu_strlcpy(field, &line[32], sizeof(field));
pt2 = atoi(field);
bu_strlcpy(field, &line[40], sizeof(field));
pt3 = atoi(field);
thick = 0.0;
pos = 0;
if (mode == PLATE_MODE) {
bu_strlcpy(field, &line[56], sizeof(field));
thick = atof(field) * 25.4;
bu_strlcpy(field, &line[64], sizeof(field));
pos = atoi(field);
if (pos == 0)
pos = POS_FRONT;
if (debug)
bu_log("\tplate mode: thickness = %f\n", thick);
}
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck())
bu_log("memory corrupted before call to Add_bot_face()\n");
Add_bot_face(pt1, pt2, pt3, thick, pos);
if (bu_debug&BU_DEBUG_MEM_CHECK && bu_mem_barriercheck())
bu_log("memory corrupted after call to Add_bot_face()\n");
}
