|
1 /* |
|
2 * LDForge: LDraw parts authoring CAD |
|
3 * Copyright (C) 2013 Santeri Piippo |
|
4 * |
|
5 * This program is free software: you can redistribute it and/or modify |
|
6 * it under the terms of the GNU General Public License as published by |
|
7 * the Free Software Foundation, either version 3 of the License, or |
|
8 * (at your option) any later version. |
|
9 * |
|
10 * This program is distributed in the hope that it will be useful, |
|
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
13 * GNU General Public License for more details. |
|
14 * |
|
15 * You should have received a copy of the GNU General Public License |
|
16 * along with this program. If not, see <http://www.gnu.org/licenses/>. |
|
17 */ |
|
18 |
|
19 #include <math.h> |
|
20 #include <locale.h> |
|
21 #include <qcolor.h> |
|
22 #include "common.h" |
|
23 #include "misc.h" |
|
24 #include "gui.h" |
|
25 |
|
26 // Prime number table. |
|
27 const ushort g_uaPrimes[NUM_PRIMES] = { |
|
28 2, 3, 5, 7, 11, 13, 17, 19, 23, 29, |
|
29 31, 37, 41, 43, 47, 53, 59, 61, 67, 71, |
|
30 73, 79, 83, 89, 97, 101, 103, 107, 109, 113, |
|
31 127, 131, 137, 139, 149, 151, 157, 163, 167, 173, |
|
32 179, 181, 191, 193, 197, 199, 211, 223, 227, 229, |
|
33 233, 239, 241, 251, 257, 263, 269, 271, 277, 281, |
|
34 283, 293, 307, 311, 313, 317, 331, 337, 347, 349, |
|
35 353, 359, 367, 373, 379, 383, 389, 397, 401, 409, |
|
36 419, 421, 431, 433, 439, 443, 449, 457, 461, 463, |
|
37 467, 479, 487, 491, 499, 503, 509, 521, 523, 541, |
|
38 547, 557, 563, 569, 571, 577, 587, 593, 599, 601, |
|
39 607, 613, 617, 619, 631, 641, 643, 647, 653, 659, |
|
40 661, 673, 677, 683, 691, 701, 709, 719, 727, 733, |
|
41 739, 743, 751, 757, 761, 769, 773, 787, 797, 809, |
|
42 811, 821, 823, 827, 829, 839, 853, 857, 859, 863, |
|
43 877, 881, 883, 887, 907, 911, 919, 929, 937, 941, |
|
44 947, 953, 967, 971, 977, 983, 991, 997, 1009, 1013, |
|
45 1019, 1021, 1031, 1033, 1039, 1049, 1051, 1061, 1063, 1069, |
|
46 1087, 1091, 1093, 1097, 1103, 1109, 1117, 1123, 1129, 1151, |
|
47 1153, 1163, 1171, 1181, 1187, 1193, 1201, 1213, 1217, 1223, |
|
48 1229, 1231, 1237, 1249, 1259, 1277, 1279, 1283, 1289, 1291, |
|
49 1297, 1301, 1303, 1307, 1319, 1321, 1327, 1361, 1367, 1373, |
|
50 1381, 1399, 1409, 1423, 1427, 1429, 1433, 1439, 1447, 1451, |
|
51 1453, 1459, 1471, 1481, 1483, 1487, 1489, 1493, 1499, 1511, |
|
52 1523, 1531, 1543, 1549, 1553, 1559, 1567, 1571, 1579, 1583, |
|
53 1597, 1601, 1607, 1609, 1613, 1619, 1621, 1627, 1637, 1657, |
|
54 1663, 1667, 1669, 1693, 1697, 1699, 1709, 1721, 1723, 1733, |
|
55 1741, 1747, 1753, 1759, 1777, 1783, 1787, 1789, 1801, 1811, |
|
56 1823, 1831, 1847, 1861, 1867, 1871, 1873, 1877, 1879, 1889, |
|
57 1901, 1907, 1913, 1931, 1933, 1949, 1951, 1973, 1979, 1987, |
|
58 1993, 1997, 1999, 2003, 2011, 2017, 2027, 2029, 2039, 2053, |
|
59 2063, 2069, 2081, 2083, 2087, 2089, 2099, 2111, 2113, 2129, |
|
60 2131, 2137, 2141, 2143, 2153, 2161, 2179, 2203, 2207, 2213, |
|
61 2221, 2237, 2239, 2243, 2251, 2267, 2269, 2273, 2281, 2287, |
|
62 2293, 2297, 2309, 2311, 2333, 2339, 2341, 2347, 2351, 2357, |
|
63 2371, 2377, 2381, 2383, 2389, 2393, 2399, 2411, 2417, 2423, |
|
64 2437, 2441, 2447, 2459, 2467, 2473, 2477, 2503, 2521, 2531, |
|
65 2539, 2543, 2549, 2551, 2557, 2579, 2591, 2593, 2609, 2617, |
|
66 2621, 2633, 2647, 2657, 2659, 2663, 2671, 2677, 2683, 2687, |
|
67 2689, 2693, 2699, 2707, 2711, 2713, 2719, 2729, 2731, 2741, |
|
68 2749, 2753, 2767, 2777, 2789, 2791, 2797, 2801, 2803, 2819, |
|
69 2833, 2837, 2843, 2851, 2857, 2861, 2879, 2887, 2897, 2903, |
|
70 2909, 2917, 2927, 2939, 2953, 2957, 2963, 2969, 2971, 2999, |
|
71 3001, 3011, 3019, 3023, 3037, 3041, 3049, 3061, 3067, 3079, |
|
72 3083, 3089, 3109, 3119, 3121, 3137, 3163, 3167, 3169, 3181, |
|
73 3187, 3191, 3203, 3209, 3217, 3221, 3229, 3251, 3253, 3257, |
|
74 3259, 3271, 3299, 3301, 3307, 3313, 3319, 3323, 3329, 3331, |
|
75 3343, 3347, 3359, 3361, 3371, 3373, 3389, 3391, 3407, 3413, |
|
76 3433, 3449, 3457, 3461, 3463, 3467, 3469, 3491, 3499, 3511, |
|
77 3517, 3527, 3529, 3533, 3539, 3541, 3547, 3557, 3559, 3571, |
|
78 }; |
|
79 |
|
80 // ============================================================================= |
|
81 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
|
82 // ============================================================================= |
|
83 // Grid stuff |
|
84 cfg (int, grid, Grid::Medium); |
|
85 EXTERN_ACTION (gridCoarse) |
|
86 EXTERN_ACTION (gridMedium) |
|
87 EXTERN_ACTION (gridFine) |
|
88 |
|
89 cfg (float, grid_coarse_x, 5.0f); |
|
90 cfg (float, grid_coarse_y, 5.0f); |
|
91 cfg (float, grid_coarse_z, 5.0f); |
|
92 cfg (float, grid_coarse_angle, 45.0f); |
|
93 cfg (float, grid_medium_x, 1.0f); |
|
94 cfg (float, grid_medium_y, 1.0f); |
|
95 cfg (float, grid_medium_z, 1.0f); |
|
96 cfg (float, grid_medium_angle, 22.5f); |
|
97 cfg (float, grid_fine_x, 0.1f); |
|
98 cfg (float, grid_fine_y, 0.1f); |
|
99 cfg (float, grid_fine_z, 0.1f); |
|
100 cfg (float, grid_fine_angle, 7.5f); |
|
101 |
|
102 const gridinfo g_GridInfo[3] = { |
|
103 { "Coarse", { &grid_coarse_x, &grid_coarse_y, &grid_coarse_z, &grid_coarse_angle }, &ACTION (gridCoarse) }, |
|
104 { "Medium", { &grid_medium_x, &grid_medium_y, &grid_medium_z, &grid_medium_angle }, &ACTION (gridMedium) }, |
|
105 { "Fine", { &grid_fine_x, &grid_fine_y, &grid_fine_z, &grid_fine_angle }, &ACTION (gridFine) } |
|
106 }; |
|
107 |
|
108 // ============================================================================= |
|
109 double Grid::snap (double in, const Grid::Config axis) { |
|
110 const double gridval = currentGrid ().confs[axis]->value; |
|
111 const long mult = abs (in / gridval); |
|
112 const bool neg = (in < 0); |
|
113 |
|
114 double out = mult * gridval; |
|
115 |
|
116 if (abs<double> (in) - (mult * gridval) > gridval / 2) |
|
117 out += gridval; |
|
118 |
|
119 if (neg && out != 0) |
|
120 out *= -1; |
|
121 |
|
122 return out; |
|
123 } |
|
124 |
|
125 // ============================================================================= |
|
126 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
|
127 // ============================================================================= |
|
128 str ftoa (double fCoord) { |
|
129 // Disable the locale first so that the decimal point will not |
|
130 // turn into anything weird (like commas) |
|
131 setlocale (LC_NUMERIC, "C"); |
|
132 |
|
133 str zRep = fmt ("%f", fCoord); |
|
134 |
|
135 // Remove trailing zeroes |
|
136 while (zRep[~zRep - 1] == '0') |
|
137 zRep -= 1; |
|
138 |
|
139 // If there was only zeroes in the decimal place, remove |
|
140 // the decimal point now. |
|
141 if (zRep[~zRep - 1] == '.') |
|
142 zRep -= 1; |
|
143 |
|
144 return zRep; |
|
145 } |
|
146 |
|
147 // ============================================================================= |
|
148 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
|
149 // ============================================================================= |
|
150 bool isNumber (str& zToken) { |
|
151 char* cpPointer = &zToken[0]; |
|
152 bool bGotDot = false; |
|
153 |
|
154 // Allow leading hyphen for negatives |
|
155 if (*cpPointer == '-') |
|
156 cpPointer++; |
|
157 |
|
158 while (*cpPointer != '\0') { |
|
159 if (*cpPointer == '.' && !bGotDot) { |
|
160 // Decimal point |
|
161 bGotDot = true; |
|
162 cpPointer++; |
|
163 continue; |
|
164 } |
|
165 |
|
166 if (*cpPointer >= '0' && *cpPointer <= '9') { |
|
167 cpPointer++; |
|
168 continue; // Digit |
|
169 } |
|
170 |
|
171 // If the above cases didn't catch this character, it was |
|
172 // illegal and this is therefore not a number. |
|
173 return false; |
|
174 } |
|
175 |
|
176 return true; |
|
177 } |
|
178 |
|
179 // ============================================================================= |
|
180 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
|
181 // ============================================================================= |
|
182 void simplify (short& dNum, short& dDenom) { |
|
183 bool bRepeat; |
|
184 |
|
185 do { |
|
186 bRepeat = false; |
|
187 |
|
188 for (ulong x = 0; x < NUM_PRIMES; x++) { |
|
189 ulong i = NUM_PRIMES - x - 1; |
|
190 ushort uPrime = g_uaPrimes[i]; |
|
191 |
|
192 if (dNum <= uPrime || dDenom <= uPrime) |
|
193 continue; |
|
194 |
|
195 if ((dNum % uPrime == 0) && (dDenom % uPrime == 0)) { |
|
196 dNum /= uPrime; |
|
197 dDenom /= uPrime; |
|
198 bRepeat = true; |
|
199 break; |
|
200 } |
|
201 } |
|
202 } while (bRepeat); |
|
203 } |
|
204 |
|
205 // ============================================================================= |
|
206 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * |
|
207 // ============================================================================= |
|
208 StringParser::StringParser (str zInText, char cSeparator) { |
|
209 zaTokens = zInText.split (cSeparator, true); |
|
210 dPos = -1; |
|
211 } |
|
212 |
|
213 // ----------------------------------------------------------------------------- |
|
214 bool StringParser::atBeginning () { |
|
215 return (dPos == -1); |
|
216 } |
|
217 |
|
218 // ----------------------------------------------------------------------------- |
|
219 bool StringParser::atEnd () { |
|
220 return (dPos == (signed) zaTokens.size () - 1); |
|
221 } |
|
222 |
|
223 // ----------------------------------------------------------------------------- |
|
224 bool StringParser::getToken (str& zVal, const ushort uInPos) { |
|
225 if (uInPos >= zaTokens.size()) |
|
226 return false; |
|
227 |
|
228 zVal = zaTokens[uInPos]; |
|
229 return true; |
|
230 } |
|
231 |
|
232 // ----------------------------------------------------------------------------- |
|
233 bool StringParser::next (str& zVal) { |
|
234 return getToken (zVal, ++dPos); |
|
235 } |
|
236 |
|
237 // ----------------------------------------------------------------------------- |
|
238 bool StringParser::peekNext (str& zVal) { |
|
239 return getToken (zVal, dPos + 1); |
|
240 } |
|
241 |
|
242 // ----------------------------------------------------------------------------- |
|
243 bool StringParser::findToken (short& dResult, char const* sNeedle, short dArgs) { |
|
244 for (ushort i = 0; i < (zaTokens.size () - dArgs); ++i) { |
|
245 if (zaTokens[i] == sNeedle) { |
|
246 dResult = i; |
|
247 return true; |
|
248 } |
|
249 } |
|
250 |
|
251 return false; |
|
252 } |
|
253 |
|
254 // ----------------------------------------------------------------------------- |
|
255 void StringParser::rewind () { |
|
256 dPos = -1; |
|
257 } |
|
258 |
|
259 // ----------------------------------------------------------------------------- |
|
260 void StringParser::seek (short int dAmount, bool bRelative) { |
|
261 dPos = (bRelative ? dPos : 0) + dAmount; |
|
262 } |
|
263 |
|
264 // ----------------------------------------------------------------------------- |
|
265 size_t StringParser::size () { |
|
266 return zaTokens.size(); |
|
267 } |
|
268 |
|
269 // ----------------------------------------------------------------------------- |
|
270 bool StringParser |
|
271 ::tokenCompare (short int dInPos, const char* sOther) { |
|
272 str tok; |
|
273 if (!getToken (tok, dInPos)) |
|
274 return false; |
|
275 |
|
276 return (tok == sOther); |
|
277 } |