| | |
| | | #include "triangle.h" |
| | | #include<math.h> |
| | | |
| | | ts_bool init_triangle_list(ts_triangle_list *tlist){ |
| | | /** @brief Prepares the list for triangles. |
| | | * |
| | | * Create empty list for holding the information on triangles. Triangles are |
| | | * added later on with triangle_add(). |
| | | * Returns pointer to the tlist datastructure it has created. This pointer must |
| | | * be assigned to some variable or it will be lost. |
| | | * |
| | | * |
| | | * Example of usage: |
| | | * ts_triangle_list *tlist; |
| | | * tlist=triangle_data_free(); |
| | | * |
| | | * Initalized data structure for holding the information on triangles. |
| | | * |
| | | */ |
| | | ts_triangle_list *init_triangle_list(){ |
| | | ts_triangle_list *tlist=(ts_triangle_list *)malloc(sizeof(ts_triangle_list)); |
| | | tlist->n = 0; |
| | | tlist->triangle=NULL; |
| | | return TS_SUCCESS; |
| | | tlist->tria=NULL; |
| | | return tlist; |
| | | } |
| | | |
| | | ts_bool clear_triangle_values(ts_triangle *triang,ts_uint idx){ |
| | | triang->idx=idx; |
| | | triang->neigh_no=0; |
| | | triang->vertex[0]=NULL; |
| | | triang->vertex[1]=NULL; |
| | | triang->vertex[2]=NULL; |
| | | triang->neigh=NULL; |
| | | triang->xnorm=0; |
| | | triang->ynorm=0; |
| | | triang->znorm=0; |
| | | return TS_SUCCESS; |
| | | } |
| | | |
| | | ts_bool triangle_add(ts_triangle_list *tlist, ts_vertex *vtx1, ts_vertex *vtx2, ts_vertex *vtx3){ |
| | | /** @brief Add the triangle to the triangle list and create necessary data |
| | | * structures. |
| | | * |
| | | * Add the triangle ts_triangle with ts_triangle_data to the ts_triangle_list. |
| | | * The triangle list is resized, the ts_triangle is allocated and |
| | | * ts_triangle_data is allocated and zeroed. The function receives 4 arguments: |
| | | * ts_triangle_list *tlist as list of triangles and 3 ts_vertex *vtx as |
| | | * vertices that are used to form a triangle. Returns a pointer to newly |
| | | * created triangle. This pointer doesn't need assigning, since it is |
| | | * referenced by triangle list. |
| | | * |
| | | * WARNING: Function can be accelerated a bit by removing the NULL checks. |
| | | * However the time gained by removal doesn't justify the time spent by |
| | | * debugging stupid NULL pointers. |
| | | * |
| | | * Example of usage: |
| | | * triangle_add(tlist, vlist->vtx[1], vlist->vtx[2], vlist->vtx[3]); |
| | | * |
| | | * Creates a triangle with given vertices and puts it into the list. |
| | | * |
| | | */ |
| | | ts_triangle *triangle_add(ts_triangle_list *tlist, ts_vertex *vtx1, ts_vertex *vtx2, ts_vertex *vtx3){ |
| | | if(vtx1==NULL || vtx2==NULL || vtx3==NULL){ |
| | | return NULL; |
| | | } |
| | | tlist->n++; |
| | | tlist->triangle=realloc(tlist->triangle,tlist->n*sizeof(ts_triangle)); |
| | | if(tlist->triangle==NULL) fatal("Cannot reallocate memory for additional ts_triangle.",5); |
| | | clear_triangle_values(&tlist->triangle[tlist->n-1],tlist->n-1); |
| | | tlist->tria=(ts_triangle **)realloc(tlist->tria,tlist->n*sizeof(ts_triangle *)); |
| | | if(tlist->tria==NULL) fatal("Cannot reallocate memory for additional ts_triangle.",5); |
| | | |
| | | tlist->tria[tlist->n-1]=(ts_triangle *)calloc(1,sizeof(ts_triangle)); |
| | | if(tlist->tria[tlist->n-1]==NULL) fatal("Cannot reallocate memory for additional ts_triangle.",5); |
| | | tlist->tria[tlist->n-1]->data=(ts_triangle_data *)calloc(1,sizeof(ts_triangle_data)); |
| | | |
| | | //NOW insert vertices! |
| | | tlist->triangle[tlist->n - 1].idx=tlist->n; |
| | | tlist->triangle[tlist->n - 1].vertex[0]=vtx1; |
| | | tlist->triangle[tlist->n - 1].vertex[1]=vtx2; |
| | | tlist->triangle[tlist->n - 1].vertex[2]=vtx3; |
| | | return TS_SUCCESS; |
| | | tlist->tria[tlist->n - 1]->idx=tlist->n-1; |
| | | tlist->tria[tlist->n - 1]->data->vertex[0]=vtx1; |
| | | tlist->tria[tlist->n - 1]->data->vertex[1]=vtx2; |
| | | tlist->tria[tlist->n - 1]->data->vertex[2]=vtx3; |
| | | return tlist->tria[tlist->n-1]; |
| | | } |
| | | |
| | | /** @brief Add the neigbour to triangles. |
| | | * |
| | | * Add the neigbour to the list of neighbouring triangles. The |
| | | * neighbouring triangles are those, who share two vertices. Function resizes |
| | | * the list and adds the pointer to neighbour. It receives two arguments of |
| | | * ts_triangle type. It then adds eachother to eachother's list. Upon |
| | | * success it returns TS_SUCCESS, upon detecting NULL pointers |
| | | * returns TS_FAIL and it FATALY ends when the data structure |
| | | * cannot be resized. |
| | | * |
| | | * |
| | | * WARNING: Function can be accelerated a bit by removing the NULL checks. |
| | | * However the time gained by removal doesn't justify the time spent by |
| | | * debugging stupid NULL pointers. |
| | | * |
| | | * Example of usage: |
| | | * triangle_remove_neighbour(tlist->tria[3], tlist->tria[4]); |
| | | * |
| | | * Triangles 3 and 4 are not neighbours anymore. |
| | | * |
| | | */ |
| | | |
| | | ts_bool triangle_add_neighbour(ts_triangle *tria, ts_triangle *ntria){ |
| | | // int i; |
| | | //fprintf(stderr,"Sosedi so:\n"); |
| | | // for(i=0;i<tria->neigh_no;i++) |
| | | // fprintf(stderr,"\t %d\n",tria->neigh[i]); |
| | | |
| | | |
| | | tria->neigh_no++; |
| | | //We need to reallocate space! The pointer *neight must be zero if not |
| | | //having neighbours yet (if neigh_no was 0 at thime of calling |
| | | tria->neigh=realloc(tria->neigh,tria->neigh_no*sizeof(ts_triangle *)); |
| | | if(tria->neigh == NULL){ |
| | | if(tria==NULL || ntria==NULL) return TS_FAIL; |
| | | /*TODO: check if the neighbour already exists! Now there is no such check |
| | | * because of the performance issue. */ |
| | | tria->data->neigh_no++; |
| | | tria->data->neigh=realloc(tria->data->neigh,tria->data->neigh_no*sizeof(ts_triangle *)); |
| | | if(tria->data->neigh == NULL) |
| | | fatal("Reallocation of memory failed during insertion of triangle neighbour in triangle_add_neighbour",3); |
| | | } |
| | | tria->neigh[tria->neigh_no-1]=ntria; |
| | | // fprintf(stderr,"dodajamo soseda %d!\n",ntria); |
| | | |
| | | //fprintf(stderr,"Sosedi so:\n"); |
| | | // for(i=0;i<tria->neigh_no;i++) |
| | | // fprintf(stderr,"\t %d\n",tria->neigh[i]); |
| | | |
| | | |
| | | |
| | | tria->data->neigh[tria->data->neigh_no-1]=ntria; |
| | | |
| | | /* we repeat the procedure for the neighbour */ |
| | | ntria->data->neigh_no++; |
| | | ntria->data->neigh=realloc(ntria->data->neigh,ntria->data->neigh_no*sizeof(ts_triangle *)); |
| | | if(ntria->data->neigh == NULL) |
| | | fatal("Reallocation of memory failed during insertion of triangle neighbour in triangle_add_neighbour",3); |
| | | ntria->data->neigh[ntria->data->neigh_no-1]=tria; |
| | | return TS_SUCCESS; |
| | | } |
| | | |
| | | |
| | | /** @brief Remove the neigbours from triangle. |
| | | * |
| | | * Removes the neigbour from the list of neighbouring triangles. The |
| | | * neighbouring triangles are those, who share two vertices. Function resizes |
| | | * the list and deletes the pointer to neighbour. It receives two arguments of |
| | | * ts_triangle type. It then removes eachother form eachother's list. Upon |
| | | * success it returns TS_SUCCESS, upon failure to find the triangle in the |
| | | * neighbour list returns TS_FAIL and it FATALY ends when the datastructure |
| | | * cannot be resized. |
| | | * |
| | | * WARNING: The function doesn't check whether the pointer is NULL or invalid. It is the |
| | | * job of programmer to make sure the pointer is valid. |
| | | * |
| | | * WARNING: Function is slow. Do not use it often! |
| | | * |
| | | * Example of usage: |
| | | * triangle_remove_neighbour(tlist->tria[3], tlist->tria[4]); |
| | | * |
| | | * Triangles 3 and 4 are not neighbours anymore. |
| | | * |
| | | */ |
| | | ts_bool triangle_remove_neighbour(ts_triangle *tria, ts_triangle *ntria){ |
| | | ts_uint i,j=0; |
| | | /* fprintf(stderr,"Sosedi so:\n"); |
| | | for(i=0;i<tria->neigh_no;i++) |
| | | fprintf(stderr,"%d, ",tria->neigh[i]); |
| | | fprintf(stderr,"\n"); |
| | | */ |
| | | |
| | | for(i=0;i<tria->neigh_no;i++){ |
| | | if(tria->neigh[i]!=ntria){ |
| | | tria->neigh[j]=tria->neigh[i]; |
| | | ts_uint i,j=0; |
| | | if(tria==NULL || ntria==NULL) return TS_FAIL; |
| | | |
| | | for(i=0;i<tria->data->neigh_no;i++){ |
| | | if(tria->data->neigh[i]!=ntria){ |
| | | tria->data->neigh[j]=tria->data->neigh[i]; |
| | | j++; |
| | | |
| | | } |
| | | // else { |
| | | // fprintf(stderr,"was here once\n"); |
| | | |
| | | // } |
| | | } |
| | | |
| | | // fprintf(stderr,"Sosedi so:\n"); |
| | | // for(i=0;i<tria->neigh_no;i++) |
| | | // fprintf(stderr,"\t %d\n",tria->neigh[i]); |
| | | |
| | | // fprintf(stderr,"iscemo soseda %d!\n",ntria); |
| | | if(j==i) fatal("In triangle_remove_neighbour: Specified neighbour does not exist for given triangle",3); |
| | | // fprintf(stderr,"old nuber of neigh=%i\n",tria->neigh_no); |
| | | tria->neigh_no--; |
| | | // fprintf(stderr,"new nuber of neigh=%i\n",tria->neigh_no); |
| | | tria->neigh=realloc(tria->neigh,tria->neigh_no*sizeof(ts_triangle *)); |
| | | if(tria->neigh == NULL){ |
| | | fatal("Reallocation of memory failed during insertion of vertex neighbour in triangle_remove_neighbour",3); |
| | | } |
| | | if(j==i) { |
| | | return TS_FAIL; |
| | | //fatal("In triangle_remove_neighbour: Specified neighbour does not exist for given triangle",3); |
| | | } |
| | | tria->data->neigh_no--; |
| | | tria->data->neigh=(ts_triangle **)realloc(tria->data->neigh,tria->data->neigh_no*sizeof(ts_triangle *)); |
| | | if(tria->data->neigh == NULL){ |
| | | fatal("Reallocation of memory failed during removal of vertex neighbour in triangle_remove_neighbour",100); |
| | | } |
| | | /* we repeat the procedure for neighbour */ |
| | | for(i=0;i<ntria->data->neigh_no;i++){ |
| | | if(ntria->data->neigh[i]!=tria){ |
| | | ntria->data->neigh[j]=ntria->data->neigh[i]; |
| | | j++; |
| | | } |
| | | } |
| | | if(j==i) { |
| | | return TS_FAIL; |
| | | //fatal("In triangle_remove_neighbour: Specified neighbour does not exist for given triangle",3); |
| | | } |
| | | ntria->data->neigh_no--; |
| | | ntria->data->neigh=(ts_triangle **)realloc(ntria->data->neigh,ntria->data->neigh_no*sizeof(ts_triangle *)); |
| | | if(ntria->data->neigh == NULL){ |
| | | fatal("Reallocation of memory failed during removal of vertex neighbour in triangle_remove_neighbour",100); |
| | | } |
| | | return TS_SUCCESS; |
| | | } |
| | | |
| | | |
| | | /** @brief Calculates normal vector of the triangle. |
| | | |
| | | * |
| | | * Calculate normal vector of the triangle (xnorm, ynorm and znorm) and stores |
| | | * information in underlying ts_triangle_data data_structure. |
| | | * |
| | | * Function receives one argument of type ts_triangle. It should be corectly |
| | | * initialized with underlying data structure of type ts_triangle_data. the |
| | | * result is stored in triangle->data->xnorm, triangle->data->ynorm, |
| | | * triangle->data->znorm. Returns TS_SUCCESS on completion. |
| | | * |
| | | * NOTE: Function uses math.h library. pow function implementation is selected |
| | | * accordind to the setting in genreal.h |
| | | * |
| | | * Example of usage: |
| | | * triangle_normal_vector(tlist->tria[3]); |
| | | * |
| | | * Computes normals and stores information into tlist->tria[3]->xnorm, |
| | | * tlist->tria[3]->ynorm, tlist->tria[3]->znorm. |
| | | * |
| | | */ |
| | | ts_bool triangle_normal_vector(ts_triangle *tria){ |
| | | ts_double x21,x31,y21,y31,z21,z31,xden; |
| | | x21=tria->vertex[1]->x - tria->vertex[0]->x; |
| | | x31=tria->vertex[2]->x - tria->vertex[0]->x; |
| | | y21=tria->vertex[1]->y - tria->vertex[0]->y; |
| | | y31=tria->vertex[2]->y - tria->vertex[0]->y; |
| | | z21=tria->vertex[1]->z - tria->vertex[0]->z; |
| | | z31=tria->vertex[2]->z - tria->vertex[0]->z; |
| | | x21=tria->data->vertex[1]->data->x - tria->data->vertex[0]->data->x; |
| | | x31=tria->data->vertex[2]->data->x - tria->data->vertex[0]->data->x; |
| | | y21=tria->data->vertex[1]->data->y - tria->data->vertex[0]->data->y; |
| | | y31=tria->data->vertex[2]->data->y - tria->data->vertex[0]->data->y; |
| | | z21=tria->data->vertex[1]->data->z - tria->data->vertex[0]->data->z; |
| | | z31=tria->data->vertex[2]->data->z - tria->data->vertex[0]->data->z; |
| | | |
| | | tria->xnorm=y21*z31 - z21*y31; |
| | | tria->ynorm=z21*x31 - x21*z31; |
| | | tria->znorm=x21*y31 - y21*x31; |
| | | xden=tria->xnorm*tria->xnorm + tria->ynorm*tria->ynorm + tria->znorm*tria->znorm; |
| | | tria->data->xnorm=y21*z31 - z21*y31; |
| | | tria->data->ynorm=z21*x31 - x21*z31; |
| | | tria->data->znorm=x21*y31 - y21*x31; |
| | | xden=tria->data->xnorm*tria->data->xnorm + |
| | | tria->data->ynorm*tria->data->ynorm + |
| | | tria->data->znorm*tria->data->znorm; |
| | | #ifdef TS_DOUBLE_DOUBLE |
| | | xden=sqrt(xden); |
| | | #endif |
| | |
| | | #ifdef TS_DOUBLE_LONGDOUBLE |
| | | xden=sqrtl(xden); |
| | | #endif |
| | | tria->xnorm=tria->xnorm/xden; |
| | | tria->ynorm=tria->ynorm/xden; |
| | | tria->znorm=tria->znorm/xden; |
| | | tria->data->xnorm=tria->data->xnorm/xden; |
| | | tria->data->ynorm=tria->data->ynorm/xden; |
| | | tria->data->znorm=tria->data->znorm/xden; |
| | | return TS_SUCCESS; |
| | | } |
| | | |
| | | |
| | | ts_bool triangle_free(ts_triangle *triang){ |
| | | free(triang->neigh); |
| | | |
| | | |
| | | |
| | | /** @brief Frees the memory allocated for data structure of triangle data |
| | | * (ts_triangle_data) |
| | | * |
| | | * Function frees the memory of ts_triangle_data previously allocated. It |
| | | * accepts one argument, the address of data structure. It destroys all |
| | | * pointers the structure might have (currently only neigh -- the pointer to |
| | | * list of neighbouring triangles) and data structure itself. The return value |
| | | * is always TS_SUCCESS. |
| | | * |
| | | * WARNING: The function doesn't check whether the pointer is NULL or invalid. It is the |
| | | * job of programmer to make sure the pointer is valid. |
| | | * |
| | | * Example of usage: |
| | | * triangle_data_free(tlist->tria[3]->data); |
| | | * |
| | | * Clears the data structure with all pointers. |
| | | * |
| | | */ |
| | | ts_bool triangle_data_free(ts_triangle_data *data){ |
| | | if(data->neigh!=NULL) free(data->neigh); |
| | | free(data); |
| | | return TS_SUCCESS; |
| | | } |
| | | |
| | | /** @brief Frees the memory allocated for data structure of triangle list |
| | | * (ts_triangle_list) |
| | | * |
| | | * Function frees the memory of ts_triangle_list previously allocated. It |
| | | * accepts one argument, the address of data structure. It destroys all |
| | | * ts_triangle's in the list with underlying data (by calling |
| | | * triangle_data_free()), and the list itself. |
| | | * |
| | | * Should be used eveytime the deletion of triangle list (created by |
| | | * init_triangle_list() and altered by add_triangle() or remove_triangle()) is desired. |
| | | * |
| | | * WARNING: The function doesn't check whether the pointer is NULL or invalid. It is the |
| | | * job of programmer to make sure the pointer is valid. |
| | | * |
| | | * WARNING: Careful when destroying triangle lists. There could be pointers to |
| | | * that information remaining in structures like vertex_data. This pointers |
| | | * will be rendered invalid by this operation and should not be used anymore. |
| | | * |
| | | * Example of usage: |
| | | * triangle_list_free(tlist); |
| | | * |
| | | * Clears all the information on triangles. |
| | | * |
| | | */ |
| | | ts_bool triangle_list_free(ts_triangle_list *tlist){ |
| | | int i; |
| | | ts_uint i; |
| | | for(i=0;i<tlist->n;i++){ |
| | | triangle_free(&tlist->triangle[i]); |
| | | triangle_data_free(tlist->tria[i]->data); |
| | | free(tlist->tria[i]); |
| | | } |
| | | free(tlist->triangle); |
| | | free(tlist->tria); |
| | | free(tlist); |
| | | return TS_SUCCESS; |
| | | } |
| | | |