f9ee26ffb32ccd4724975d338cbdb148f97578db
[vrtris] / src / meshload.c
1 #if 0
2 #include <stdio.h>
3 #include <stdlib.h>
4 #include <ctype.h>
5 #include <assert.h>
6 #include "mesh.h"
7 #include "dynarr.h"
8 #include "rbtree.h"
9 #include "util.h"
10
11 struct vertex_pos_color {
12         float x, y, z;
13         float r, g, b, a;
14 };
15
16 struct facevertex {
17         int vidx, tidx, nidx;
18 };
19
20 static char *clean_line(char *s);
21 static char *parse_face_vert(char *ptr, struct facevertex *fv, int numv, int numt, int numn);
22 static int cmp_facevert(const void *ap, const void *bp);
23 static void free_rbnode_key(struct rbnode *n, void *cls);
24
25 /* merge of different indices per attribute happens during face processing.
26  *
27  * A triplet of (vertex index/texcoord index/normal index) is used as the key
28  * to search in a balanced binary search tree for vertex buffer index assigned
29  * to the same triplet if it has been encountered before. That index is
30  * appended to the index buffer.
31  *
32  * If a particular triplet has not been encountered before, a new g3d_vertex is
33  * appended to the vertex buffer. The index of this new vertex is appended to
34  * the index buffer, and also inserted into the tree for future searches.
35  */
36 int load_mesh(struct g3d_mesh *mesh, const char *fname)
37 {
38         int i, line_num = 0, result = -1;
39         int found_quad = 0;
40         FILE *fp = 0;
41         char buf[256];
42         struct vertex_pos_color *varr = 0;
43         vec3_t *narr = 0;
44         vec2_t *tarr = 0;
45         struct rbtree *rbtree = 0;
46
47         if(!(fp = fopen(fname, "rb"))) {
48                 fprintf(stderr, "load_mesh: failed to open file: %s\n", fname);
49                 goto err;
50         }
51
52         if(!(rbtree = rb_create(cmp_facevert))) {
53                 fprintf(stderr, "load_mesh: failed to create facevertex binary search tree\n");
54                 goto err;
55         }
56         rb_set_delete_func(rbtree, free_rbnode_key, 0);
57
58         if(!(mesh->varr = dynarr_alloc(0, sizeof *mesh->varr)) ||
59                         !(mesh->iarr = dynarr_alloc(0, sizeof *mesh->iarr))) {
60                 fprintf(stderr, "load_mesh: failed to allocate resizable mesh arrays\n");
61                 goto err;
62         }
63         if(!(varr = dynarr_alloc(0, sizeof *varr)) ||
64                         !(narr = dynarr_alloc(0, sizeof *narr)) ||
65                         !(tarr = dynarr_alloc(0, sizeof *tarr))) {
66                 fprintf(stderr, "load_mesh: failed to allocate resizable vertex array\n");
67                 goto err;
68         }
69
70         while(fgets(buf, sizeof buf, fp)) {
71                 char *line = clean_line(buf);
72                 ++line_num;
73
74                 if(!*line) continue;
75
76                 switch(line[0]) {
77                 case 'v':
78                         if(isspace(line[1])) {
79                                 /* vertex */
80                                 struct vertex_pos_color v;
81                                 int num;
82
83                                 num = sscanf(line + 2, "%f %f %f %f %f %f %f", &v.x, &v.y, &v.z, &v.r, &v.g, &v.b, &v.a);
84                                 if(num < 3) {
85                                         fprintf(stderr, "%s:%d: invalid vertex definition: \"%s\"\n", fname, line_num, line);
86                                         goto err;
87                                 }
88                                 switch(num) {
89                                 case 3:
90                                         v.r = 1.0f;
91                                 case 4:
92                                         v.g = 1.0f;
93                                 case 5:
94                                         v.b = 1.0f;
95                                 case 6:
96                                         v.a = 1.0f;
97                                 }
98                                 if(!(varr = dynarr_push(varr, &v))) {
99                                         fprintf(stderr, "load_mesh: failed to resize vertex buffer\n");
100                                         goto err;
101                                 }
102
103                         } else if(line[1] == 't' && isspace(line[2])) {
104                                 /* texcoord */
105                                 vec2_t tc;
106                                 if(sscanf(line + 3, "%f %f", &tc.x, &tc.y) != 2) {
107                                         fprintf(stderr, "%s:%d: invalid texcoord definition: \"%s\"\n", fname, line_num, line);
108                                         goto err;
109                                 }
110                                 if(!(tarr = dynarr_push(tarr, &tc))) {
111                                         fprintf(stderr, "load_mesh: failed to resize texcoord buffer\n");
112                                         goto err;
113                                 }
114
115                         } else if(line[1] == 'n' && isspace(line[2])) {
116                                 /* normal */
117                                 vec3_t norm;
118                                 if(sscanf(line + 3, "%f %f %f", &norm.x, &norm.y, &norm.z) != 3) {
119                                         fprintf(stderr, "%s:%d: invalid normal definition: \"%s\"\n", fname, line_num, line);
120                                         goto err;
121                                 }
122                                 if(!(narr = dynarr_push(narr, &norm))) {
123                                         fprintf(stderr, "load_mesh: failed to resize normal buffer\n");
124                                         goto err;
125                                 }
126                         }
127                         break;
128
129                 case 'f':
130                         if(isspace(line[1])) {
131                                 /* face */
132                                 char *ptr = line + 2;
133                                 struct facevertex fv;
134                                 struct rbnode *node;
135                                 int vsz = dynarr_size(varr);
136                                 int tsz = dynarr_size(tarr);
137                                 int nsz = dynarr_size(narr);
138
139                                 for(i=0; i<4; i++) {
140                                         if(!(ptr = parse_face_vert(ptr, &fv, vsz, tsz, nsz))) {
141                                                 if(i < 3 || found_quad) {
142                                                         fprintf(stderr, "%s:%d: invalid face definition: \"%s\"\n", fname, line_num, line);
143                                                         goto err;
144                                                 } else {
145                                                         break;
146                                                 }
147                                         }
148
149                                         if((node = rb_find(rbtree, &fv))) {
150                                                 uint16_t idx = (int)(intptr_t)node->data;
151                                                 if(!(mesh->iarr = dynarr_push(mesh->iarr, &idx))) {
152                                                         fprintf(stderr, "load_mesh: failed to resize index array\n");
153                                                         goto err;
154                                                 }
155                                         } else {
156                                                 uint16_t newidx = dynarr_size(mesh->varr);
157                                                 struct g3d_vertex v;
158                                                 struct facevertex *newfv;
159
160                                                 v.x = varr[fv.vidx].x;
161                                                 v.y = varr[fv.vidx].y;
162                                                 v.z = varr[fv.vidx].z;
163                                                 v.w = 1.0f;
164                                                 v.r = cround64(varr[fv.vidx].r * 255.0);
165                                                 v.g = cround64(varr[fv.vidx].g * 255.0);
166                                                 v.b = cround64(varr[fv.vidx].b * 255.0);
167                                                 v.a = cround64(varr[fv.vidx].a * 255.0);
168                                                 if(fv.tidx >= 0) {
169                                                         v.u = tarr[fv.tidx].x;
170                                                         v.v = tarr[fv.tidx].y;
171                                                 } else {
172                                                         v.u = v.x;
173                                                         v.v = v.y;
174                                                 }
175                                                 if(fv.nidx >= 0) {
176                                                         v.nx = narr[fv.nidx].x;
177                                                         v.ny = narr[fv.nidx].y;
178                                                         v.nz = narr[fv.nidx].z;
179                                                 } else {
180                                                         v.nx = v.ny = 0.0f;
181                                                         v.nz = 1.0f;
182                                                 }
183
184                                                 if(!(mesh->varr = dynarr_push(mesh->varr, &v))) {
185                                                         fprintf(stderr, "load_mesh: failed to resize combined vertex array\n");
186                                                         goto err;
187                                                 }
188                                                 if(!(mesh->iarr = dynarr_push(mesh->iarr, &newidx))) {
189                                                         fprintf(stderr, "load_mesh: failed to resize index array\n");
190                                                         goto err;
191                                                 }
192
193                                                 if((newfv = malloc(sizeof *newfv))) {
194                                                         *newfv = fv;
195                                                 }
196                                                 if(!newfv || rb_insert(rbtree, newfv, (void*)(intptr_t)newidx) == -1) {
197                                                         fprintf(stderr, "load_mesh: failed to insert facevertex to the binary search tree\n");
198                                                         goto err;
199                                                 }
200                                         }
201                                 }
202                                 if(i > 3) found_quad = 1;
203                         }
204                         break;
205
206                 default:
207                         break;
208                 }
209         }
210
211         mesh->prim = found_quad ? G3D_QUADS : G3D_TRIANGLES;
212         mesh->vcount = dynarr_size(mesh->varr);
213         mesh->icount = dynarr_size(mesh->iarr);
214         mesh->varr = dynarr_finalize(mesh->varr);
215         mesh->iarr = dynarr_finalize(mesh->iarr);
216         result = 0;     /* success */
217
218         printf("loaded %s mesh: %s: %d vertices, %d faces\n", found_quad ? "quad" : "triangle",
219                         fname, mesh->vcount, mesh->icount / mesh->prim);
220
221 err:
222         if(fp) fclose(fp);
223         dynarr_free(varr);
224         dynarr_free(narr);
225         dynarr_free(tarr);
226         if(result == -1) {
227                 dynarr_free(mesh->varr);
228                 dynarr_free(mesh->iarr);
229         }
230         rb_free(rbtree);
231         return result;
232 }
233
234 int save_mesh(struct g3d_mesh *mesh, const char *fname)
235 {
236         int i, fvcount;
237         FILE *fp;
238
239         if(!(fp = fopen(fname, "wb"))) {
240                 fprintf(stderr, "save_mesh: failed to open %s for writing\n", fname);
241                 return -1;
242         }
243         fprintf(fp, "# Wavefront OBJ file shoved in your FACE by Mindlapse. Deal with it\n");
244
245         for(i=0; i<mesh->vcount; i++) {
246                 struct g3d_vertex *v = mesh->varr + i;
247                 fprintf(fp, "v %f %f %f %f %f %f %f\n", v->x, v->y, v->z, v->r / 255.0f, v->g / 255.0f,
248                                 v->b / 255.0f, v->a / 255.0f);
249         }
250         for(i=0; i<mesh->vcount; i++) {
251                 fprintf(fp, "vn %f %f %f\n", mesh->varr[i].nx, mesh->varr[i].ny, mesh->varr[i].nz);
252         }
253         for(i=0; i<mesh->vcount; i++) {
254                 fprintf(fp, "vt %f %f\n", mesh->varr[i].u, mesh->varr[i].v);
255         }
256
257         fvcount = mesh->prim;
258         for(i=0; i<mesh->icount; i++) {
259                 int idx = mesh->iarr[i] + 1;
260
261                 if(fvcount == mesh->prim) {
262                         fprintf(fp, "\nf");
263                         fvcount = 0;
264                 }
265                 fprintf(fp, " %d/%d/%d", idx, idx, idx);
266                 ++fvcount;
267         }
268         fprintf(fp, "\n");
269
270         fclose(fp);
271         return 0;
272 }
273
274 static char *clean_line(char *s)
275 {
276         char *end;
277
278         while(*s && isspace(*s)) ++s;
279         if(!*s) return 0;
280
281         end = s;
282         while(*end && *end != '#') ++end;
283         *end = 0;
284
285         while(end > s && isspace(*end)) --end;
286         *end = 0;
287
288         return s;
289 }
290
291 static char *parse_idx(char *ptr, int *idx, int arrsz)
292 {
293         char *endp;
294         int val = strtol(ptr, &endp, 10);
295         if(endp == ptr) return 0;
296
297         if(val < 0) {   /* convert negative indices */
298                 *idx = arrsz + val;
299         } else {
300                 *idx = val - 1; /* indices in obj are 1-based */
301         }
302         return endp;
303 }
304
305 /* possible face-vertex definitions:
306  * 1. vertex
307  * 2. vertex/texcoord
308  * 3. vertex//normal
309  * 4. vertex/texcoord/normal
310  */
311 static char *parse_face_vert(char *ptr, struct facevertex *fv, int numv, int numt, int numn)
312 {
313         if(!(ptr = parse_idx(ptr, &fv->vidx, numv)))
314                 return 0;
315         if(*ptr != '/') return (!*ptr || isspace(*ptr)) ? ptr : 0;
316
317         if(*++ptr == '/') {     /* no texcoord */
318                 fv->tidx = -1;
319                 ++ptr;
320         } else {
321                 if(!(ptr = parse_idx(ptr, &fv->tidx, numt)))
322                         return 0;
323                 if(*ptr != '/') return (!*ptr || isspace(*ptr)) ? ptr : 0;
324                 ++ptr;
325         }
326
327         if(!(ptr = parse_idx(ptr, &fv->nidx, numn)))
328                 return 0;
329         return (!*ptr || isspace(*ptr)) ? ptr : 0;
330 }
331
332 static int cmp_facevert(const void *ap, const void *bp)
333 {
334         const struct facevertex *a = ap;
335         const struct facevertex *b = bp;
336
337         if(a->vidx == b->vidx) {
338                 if(a->tidx == b->tidx) {
339                         return a->nidx - b->nidx;
340                 }
341                 return a->tidx - b->tidx;
342         }
343         return a->vidx - b->vidx;
344 }
345
346 static void free_rbnode_key(struct rbnode *n, void *cls)
347 {
348         free(n->key);
349 }
350 #endif  /* 0 */