Skip to content

Commit 40502c6

Browse files
ajinguajingu
committed
Implement Hongo Bundle Adjustment
1 parent bfd1cf8 commit 40502c6

13 files changed

+710
-42
lines changed

‎Common/Correspondence/hongo/Camera_Transform.xml

+56
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,56 @@
1+
<?xml version="1.0"?>
2+
<opencv_storage>
3+
<R0 type_id="opencv-matrix">
4+
<rows>3</rows>
5+
<cols>1</cols>
6+
<dt>d</dt>
7+
<data>
8+
0. 0. 0.</data></R0>
9+
<t0 type_id="opencv-matrix">
10+
<rows>3</rows>
11+
<cols>1</cols>
12+
<dt>d</dt>
13+
<data>
14+
0. 0. 0.</data></t0>
15+
<R1 type_id="opencv-matrix">
16+
<rows>3</rows>
17+
<cols>1</cols>
18+
<dt>d</dt>
19+
<data>
20+
-2.2160216242759634e+00 -1.5812259292080553e+00
21+
1.5945248779161101e+00</data></R1>
22+
<t1 type_id="opencv-matrix">
23+
<rows>3</rows>
24+
<cols>1</cols>
25+
<dt>d</dt>
26+
<data>
27+
2.4884927877252916e-01 5.6144948333801015e-02 4.2875032779079003e-01</data></t1>
28+
<R2 type_id="opencv-matrix">
29+
<rows>3</rows>
30+
<cols>1</cols>
31+
<dt>d</dt>
32+
<data>
33+
1.0720394985063803e-01 -3.3816409533912508e+00
34+
-3.2964190192668954e+00</data></R2>
35+
<t2 type_id="opencv-matrix">
36+
<rows>3</rows>
37+
<cols>1</cols>
38+
<dt>d</dt>
39+
<data>
40+
-2.1364180256918319e-01 -1.9170060900765543e-01
41+
1.9258310751594376e-01</data></t2>
42+
<R3 type_id="opencv-matrix">
43+
<rows>3</rows>
44+
<cols>1</cols>
45+
<dt>d</dt>
46+
<data>
47+
-3.9594173181342333e-02 2.2346420299918304e+00
48+
2.1753869263286116e+00</data></R3>
49+
<t3 type_id="opencv-matrix">
50+
<rows>3</rows>
51+
<cols>1</cols>
52+
<dt>d</dt>
53+
<data>
54+
4.3953005298511316e-02 -3.3282636807227456e-01
55+
3.4792229926249130e-01</data></t3>
56+
</opencv_storage>

‎Common/Correspondence/hongo/correspondence.txt

+96
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,96 @@
1+
6 4 11 68
2+
0 3 2 4 3
3+
1 3 3 3 4
4+
2 1 3 3 4
5+
3 2 3 2 4
6+
4 3 2 3 3
7+
5 2 2 4 2
8+
0 0 1 470 183 459 198 451 176 461 161
9+
0 0 2 509 143 491 159 470 150 487 135
10+
0 0 7 479 191 498 170 520 187 501 207
11+
0 1 9 196 167 181 118 229 115 243 165
12+
0 1 10 195 63 229 31 272 54 237 88
13+
0 2 2 447 308 422 293 447 284 472 297
14+
0 2 3 492 361 476 337 484 311 499 335
15+
0 2 7 396 306 409 304 398 338 386 337
16+
0 2 8 437 320 466 346 441 373 413 347
17+
0 3 0 209 314 201 287 227 271 235 295
18+
0 3 2 179 235 207 228 222 250 194 256
19+
0 3 3 147 289 155 258 183 269 175 300
20+
1 0 1 547 191 535 192 533 160 543 156
21+
1 0 2 611 160 578 178 559 149 592 131
22+
1 0 7 554 204 584 193 606 214 575 223
23+
1 1 6 381 198 412 196 443 211 411 213
24+
1 1 9 395 338 365 318 400 299 431 322
25+
1 1 10 346 274 352 226 398 227 392 276
26+
1 2 3 347 326 311 298 337 264 373 291
27+
1 2 8 276 289 301 312 290 351 266 326
28+
1 2 9 338 340 369 359 338 380 305 364
29+
1 3 0 145 140 145 107 177 111 177 143
30+
1 3 3 98 109 117 86 136 89 116 113
31+
1 3 4 119 170 98 145 115 131 137 158
32+
1 3 5 175 175 149 182 155 164 182 157
33+
2 0 8 466 139 490 123 505 144 482 160
34+
2 1 5 128 65 114 115 94 119 106 73
35+
2 1 6 145 69 174 45 218 70 192 94
36+
2 1 10 137 169 129 117 183 114 191 166
37+
2 2 3 514 305 494 280 521 280 541 304
38+
2 2 8 464 282 481 286 458 313 444 307
39+
2 2 9 502 309 519 346 484 360 467 325
40+
2 3 0 172 340 199 318 221 334 194 355
41+
2 3 2 227 272 240 292 236 318 223 299
42+
2 3 3 163 269 199 261 207 292 171 300
43+
2 3 4 132 321 136 294 158 311 152 340
44+
3 0 3 586 148 558 158 547 144 573 135
45+
3 0 8 541 183 566 168 583 192 557 206
46+
3 1 5 191 174 192 238 167 233 166 173
47+
3 1 6 212 177 230 126 291 139 276 191
48+
3 1 10 235 283 212 237 273 218 293 265
49+
3 2 4 480 457 464 421 491 397 506 432
50+
3 2 9 428 386 448 427 414 445 396 406
51+
3 3 0 86 276 117 261 133 286 103 302
52+
3 3 2 156 238 161 265 151 279 145 251
53+
3 3 3 98 214 132 217 132 241 97 238
54+
3 3 4 55 260 66 230 81 245 68 275
55+
4 0 3 314 98 291 120 276 107 299 85
56+
4 0 8 287 157 302 130 334 147 318 173
57+
4 0 9 326 104 348 92 365 122 344 135
58+
4 1 6 306 79 322 52 350 63 334 90
59+
4 1 10 314 136 301 110 328 105 340 132
60+
4 2 4 398 102 376 79 385 66 407 89
61+
4 2 9 340 73 366 84 350 114 326 102
62+
4 2 10 391 111 399 135 372 150 362 127
63+
4 3 0 434 142 453 126 457 154 440 172
64+
4 3 4 378 135 389 103 423 112 412 145
65+
4 3 5 390 191 378 170 411 164 421 186
66+
5 0 3 522 72 498 84 485 75 510 62
67+
5 0 8 481 112 503 93 522 115 499 134
68+
5 1 6 149 183 168 142 214 156 196 196
69+
5 1 10 167 264 147 229 193 217 211 253
70+
5 2 3 513 259 492 244 526 243 546 257
71+
5 2 4 554 330 538 294 559 274 574 309
72+
5 2 9 500 266 524 299 490 323 467 290
73+
5 2 10 541 338 541 358 500 361 495 341
74+
5 3 0 147 279 181 260 198 289 164 308
75+
5 3 3 155 207 192 210 197 238 159 235
76+
0 0 0 0 0 0
77+
-1.9555 -1.69332 1.64734 0.277256 0.0580098 0.437658
78+
-1.99401 -2.58283 -3.10541 -0.266828 -0.0777264 0.274878
79+
0.245895 2.12622 2.31757 0.0139723 -0.347236 0.297413
80+
1.42041 0.272343 -1.5042 0.0887221 -0.0466498 0.363894
81+
1.59669 0.922568 -1.63351 0.109747 -0.0451994 0.27775
82+
1.20821 1.41366 -2.20434 0.0857217 -0.076077 0.365969
83+
0.603774 1.44785 -2.50315 0.138036 -0.0491383 0.36221
84+
-1.14272 -1.42565 2.40652 -0.013593 -0.0657998 0.316741
85+
-1.23106 -2.15153 0.0653822 0.0906027 -0.102215 0.338163
86+
0 0 0 0 0 0
87+
0 1.65163 -2.6724 0 -0.0190211 -0.0117557
88+
-0.747327 1.02861 -1.66432 0.0180902 -0.00587785 -0.0117557
89+
-1.06896 0.347326 -0.561985 0.0111803 0.0153884 -0.0117557
90+
-1.06896 -0.347326 0.561985 -0.0111803 0.0153884 -0.0117557
91+
-0.747327 -1.02861 1.66432 -0.0180902 -0.00587785 -0.0117557
92+
1.95653 -0.635714 -0.392892 -0.0111803 -0.0153884 -0.0307768
93+
1.95653 0.635714 0.392892 0.0111803 -0.0153884 -0.0307768
94+
1.32131 1.81862 1.12397 0.0180902 0.00587785 -0.0307768
95+
0 2.6724 1.65163 0 0.0190211 -0.0307768
96+
1.32131 -1.81862 -1.12397 -0.0180902 0.00587785 -0.0307768

‎Common/Correspondence/hongo/marker_geometry.txt

+12
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,12 @@
1+
11
2+
0 0 0 0 0 0 0
3+
1 0 1.65163 -2.6724 0 -0.0190211 -0.0117557
4+
2 -0.747327 1.02861 -1.66432 0.0180902 -0.00587785 -0.0117557
5+
3 -1.06896 0.347326 -0.561985 0.0111803 0.0153884 -0.0117557
6+
4 -1.06896 -0.347326 0.561985 -0.0111803 0.0153884 -0.0117557
7+
5 -0.747327 -1.02861 1.66432 -0.0180902 -0.00587785 -0.0117557
8+
6 1.95653 -0.635714 -0.392892 -0.0111803 -0.0153884 -0.0307768
9+
7 1.95653 0.635714 0.392892 0.0111803 -0.0153884 -0.0307768
10+
9 1.32131 1.81862 1.12397 0.0180902 0.00587785 -0.0307768
11+
10 0 2.6724 1.65163 0 0.0190211 -0.0307768
12+
23 1.32131 -1.81862 -1.12397 -0.0180902 0.00587785 -0.0307768

‎Common/Correspondence/hongo/marker_geometry_rot.txt

+12
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,12 @@
1+
11
2+
0 1.000000 -0.000000 -0.000000 0.000000 1.000000 0.000000 0.000000 0.000000 1.000000 0.000000 0.000000 0.000000
3+
1 -1.000000 -0.000000 0.000000 -0.000000 -0.447214 -0.894427 0.000000 -0.894427 0.447214 0.000000 -1.902113 -1.175571
4+
2 -0.309017 0.425325 0.850651 -0.951057 -0.138197 -0.276393 0.000000 -0.894427 0.447214 1.809017 -0.587785 -1.175571
5+
3 0.809017 0.262866 0.525731 -0.587785 0.361803 0.723607 0.000000 -0.894427 0.447214 1.118034 1.538842 -1.175571
6+
4 0.809017 -0.262866 -0.525731 0.587785 0.361803 0.723607 0.000000 -0.894427 0.447214 -1.118034 1.538842 -1.175571
7+
5 -0.309017 -0.425325 -0.850651 0.951057 -0.138197 -0.276393 -0.000000 -0.894427 0.447214 -1.809017 -0.587785 -1.175571
8+
6 0.809017 -0.262866 -0.525731 -0.587785 -0.361803 -0.723607 -0.000000 0.894427 -0.447214 -1.118034 -1.538842 -3.077684
9+
7 0.809017 0.262866 0.525731 0.587785 -0.361803 -0.723607 -0.000000 0.894427 -0.447214 1.118034 -1.538842 -3.077684
10+
9 -0.309017 0.425325 0.850651 0.951057 0.138197 0.276393 0.000000 0.894427 -0.447214 1.809017 0.587785 -3.077684
11+
10 -1.000000 -0.000000 -0.000000 -0.000000 0.447214 0.894427 -0.000000 0.894427 -0.447214 0.000000 1.902113 -3.077684
12+
23 -0.309017 -0.425325 -0.850651 -0.951057 0.138197 0.276393 0.000000 0.894427 -0.447214 -1.809017 0.587785 -3.077684

0 commit comments

Comments
 (0)