Ben NanoNote 3D scans
Sign in or create your account | Project List | Help
Ben NanoNote 3D scans Git Source Tree
Root/
Source at commit b8bba1d3abe4db362c457a9eeb849fdaaaad1cc5 created 13 years 6 months ago. By Werner Almesberger, The GUI can now switch among operations. | |
---|---|
1 | /* |
2 | * overlap.c - Overlap two parallel faces |
3 | * |
4 | * Written 2010 by Werner Almesberger |
5 | * Copyright 2010 by Werner Almesberger |
6 | * |
7 | * This program is free software; you can redistribute it and/or modify |
8 | * it under the terms of the GNU General Public License as published by |
9 | * the Free Software Foundation; either version 2 of the License, or |
10 | * (at your option) any later version. |
11 | */ |
12 | |
13 | |
14 | #include <stdlib.h> |
15 | #include <stdio.h> |
16 | #include <math.h> |
17 | #include <limits.h> |
18 | #include <gtk/gtk.h> |
19 | |
20 | #include "face.h" |
21 | #include "overlap.h" |
22 | |
23 | |
24 | #define UNDEF_F HUGE_VAL |
25 | |
26 | |
27 | static double ramp(int z0, double w0, int z1, double w1) |
28 | { |
29 | if (z0 != UNDEF && z1 != UNDEF) |
30 | return w0 == 0 && w1 == 0 ? z0 : z0*w0+z1*w1; |
31 | if (z0 == UNDEF && z0 == UNDEF) |
32 | return UNDEF_F; |
33 | if (z0 == UNDEF && w0 < w1) |
34 | return z1; |
35 | if (z1 == UNDEF && w0 > w1) |
36 | return z0; |
37 | return UNDEF_F; |
38 | } |
39 | |
40 | |
41 | static double zmix(struct face *f, double x, double y) |
42 | { |
43 | int xa, xb, ya, yb; |
44 | double zx0, zx1; |
45 | |
46 | xa = floor(x); |
47 | xb = ceil(x); |
48 | ya = floor(y); |
49 | yb = ceil(y); |
50 | |
51 | zx0 = ramp( |
52 | get_bounded(f->a, xa, ya), yb-y, |
53 | get_bounded(f->a, xa, yb), y-ya); |
54 | zx1 = ramp( |
55 | get_bounded(f->a, xb, ya), yb-y, |
56 | get_bounded(f->a, xb, yb), y-ya); |
57 | |
58 | return ramp(zx0, xb-x, zx1, x-xa); |
59 | } |
60 | |
61 | |
62 | static void draw_image(GtkWidget *widget, struct face *f) |
63 | { |
64 | guchar *rgbbuf, *p; |
65 | int x, y; |
66 | double z; |
67 | |
68 | rgbbuf = p = calloc(f->sx*f->sy, 3); |
69 | if (!rgbbuf) { |
70 | perror("calloc"); |
71 | exit(1); |
72 | } |
73 | for (y = f->sy-1; y >= 0; y--) |
74 | for (x = 0; x != f->sx ; x++) { |
75 | int xa = x+f->a->min_x; |
76 | int ya = y+f->a->min_y; |
77 | |
78 | z = zmix(f, |
79 | xa*f->m.a[0][0]+ya*f->m.a[0][1]+f->m.b[0], |
80 | xa*f->m.a[1][0]+ya*f->m.a[1][1]+f->m.b[1]); |
81 | if (z == UNDEF_F) { |
82 | p += 3; |
83 | continue; |
84 | } |
85 | z = 256.0*(z-f->a->min_z)/(f->a->max_z-f->a->min_z); |
86 | if (z < 0) |
87 | z = 0; |
88 | if (z > 255) |
89 | z = 255; |
90 | *p++ = z; |
91 | *p++ = z; |
92 | *p++ = z; |
93 | } |
94 | gdk_draw_rgb_image(widget->window, |
95 | widget->style->fg_gc[GTK_STATE_NORMAL], |
96 | 0, 0, f->sx, f->sy, GDK_RGB_DITHER_MAX, rgbbuf, f->sx*3); |
97 | free(rgbbuf); |
98 | } |
99 | |
100 | |
101 | /* |
102 | * Rotate such that a point at distance "r" moves one unit. Rotate |
103 | * counter-clockwise for r > 1, clockwise for r < 0. |
104 | */ |
105 | |
106 | static void rotate(struct matrix *m, double r) |
107 | { |
108 | struct matrix t; |
109 | double s, c; |
110 | |
111 | s = 1/r; |
112 | c = sqrt(1-s*s); |
113 | t.a[0][0] = m->a[0][0]*c-m->a[1][0]*s; |
114 | t.a[0][1] = m->a[0][1]*c-m->a[1][1]*s; |
115 | t.a[1][0] = m->a[1][0]*c+m->a[0][0]*s; |
116 | t.a[1][1] = m->a[1][1]*c+m->a[0][1]*s; |
117 | t.b[0] = m->b[0]*c-m->b[1]*s; |
118 | t.b[1] = m->b[0]*s+m->b[1]*c; |
119 | *m = t; |
120 | } |
121 | |
122 | |
123 | static gboolean scroll_event(GtkWidget *widget, GdkEventScroll *event, |
124 | gpointer data) |
125 | { |
126 | GtkWidget *da = gtk_bin_get_child(GTK_BIN(widget)); |
127 | struct face *f = data; |
128 | int dx = event->x-f->sx/2; |
129 | int dy = event->y-f->sy/2; |
130 | double r = hypot(dx, dy); |
131 | |
132 | if (r < 1) |
133 | return TRUE; |
134 | switch (event->direction) { |
135 | case GDK_SCROLL_UP: |
136 | rotate(&f->m, r); |
137 | draw_image(da, f); |
138 | break; |
139 | case GDK_SCROLL_DOWN: |
140 | rotate(&f->m, -r); |
141 | draw_image(da, f); |
142 | break; |
143 | default: |
144 | /* ignore */; |
145 | } |
146 | return TRUE; |
147 | } |
148 | |
149 | |
150 | static gboolean expose_event(GtkWidget *widget, GdkEventExpose *event, |
151 | gpointer user_data) |
152 | { |
153 | draw_image(widget, user_data); |
154 | return TRUE; |
155 | } |
156 | |
157 | |
158 | |
159 | void overlap(GtkWidget *canvas, struct face *f) |
160 | { |
161 | GtkWidget *evbox, *da; |
162 | |
163 | evbox = gtk_event_box_new(); |
164 | da = gtk_drawing_area_new(); |
165 | gtk_widget_set_size_request(da, f->sx, f->sy); |
166 | gtk_container_add(GTK_CONTAINER(canvas), evbox); |
167 | gtk_container_add(GTK_CONTAINER(evbox), da); |
168 | |
169 | draw_image(da, f); |
170 | |
171 | g_signal_connect(G_OBJECT(evbox), "scroll-event", |
172 | G_CALLBACK(scroll_event), f); |
173 | g_signal_connect(G_OBJECT(da), "expose-event", |
174 | G_CALLBACK(expose_event), f); |
175 | |
176 | return evbox; |
177 | } |
178 |
Branches:
master