1 /******************************************************************************
2 * Author: Laurent Kneip *
3 * Contact: kneip.laurent@gmail.com *
4 * License: Copyright (c) 2013 Laurent Kneip, ANU. All rights reserved. *
5 * *
6 * Redistribution and use in source and binary forms, with or without *
7 * modification, are permitted provided that the following conditions *
8 * are met: *
9 * * Redistributions of source code must retain the above copyright *
10 * notice, this list of conditions and the following disclaimer. *
11 * * Redistributions in binary form must reproduce the above copyright *
12 * notice, this list of conditions and the following disclaimer in the *
13 * documentation and/or other materials provided with the distribution. *
14 * * Neither the name of ANU nor the names of its contributors may be *
15 * used to endorse or promote products derived from this software without *
16 * specific prior written permission. *
17 * *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"*
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE *
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE *
21 * ARE DISCLAIMED. IN NO EVENT SHALL ANU OR THE CONTRIBUTORS BE LIABLE *
22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL *
23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR *
24 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER *
25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT *
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY *
27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF *
28 * SUCH DAMAGE. *
29 ******************************************************************************/
30
31
32 #include <opengv/relative_pose/modules/fivept_kneip/modules.hpp>
33
34
35 void
sPolynomial30(Eigen::Matrix<double,66,197> & groebnerMatrix)36 opengv::relative_pose::modules::fivept_kneip::sPolynomial30( Eigen::Matrix<double,66,197> & groebnerMatrix )
37 {
38 groebnerMatrix(30,1) = (groebnerMatrix(0,1)/(groebnerMatrix(0,0))-groebnerMatrix(1,1)/(groebnerMatrix(1,0)));
39 groebnerMatrix(30,2) = (groebnerMatrix(0,2)/(groebnerMatrix(0,0))-groebnerMatrix(1,2)/(groebnerMatrix(1,0)));
40 groebnerMatrix(30,3) = (groebnerMatrix(0,3)/(groebnerMatrix(0,0))-groebnerMatrix(1,3)/(groebnerMatrix(1,0)));
41 groebnerMatrix(30,4) = (groebnerMatrix(0,4)/(groebnerMatrix(0,0))-groebnerMatrix(1,4)/(groebnerMatrix(1,0)));
42 groebnerMatrix(30,5) = (groebnerMatrix(0,5)/(groebnerMatrix(0,0))-groebnerMatrix(1,5)/(groebnerMatrix(1,0)));
43 groebnerMatrix(30,6) = (groebnerMatrix(0,6)/(groebnerMatrix(0,0))-groebnerMatrix(1,6)/(groebnerMatrix(1,0)));
44 groebnerMatrix(30,8) = (groebnerMatrix(0,8)/(groebnerMatrix(0,0))-groebnerMatrix(1,8)/(groebnerMatrix(1,0)));
45 groebnerMatrix(30,10) = (groebnerMatrix(0,10)/(groebnerMatrix(0,0))-groebnerMatrix(1,10)/(groebnerMatrix(1,0)));
46 groebnerMatrix(30,11) = (groebnerMatrix(0,11)/(groebnerMatrix(0,0))-groebnerMatrix(1,11)/(groebnerMatrix(1,0)));
47 groebnerMatrix(30,12) = (groebnerMatrix(0,12)/(groebnerMatrix(0,0))-groebnerMatrix(1,12)/(groebnerMatrix(1,0)));
48 groebnerMatrix(30,13) = (groebnerMatrix(0,13)/(groebnerMatrix(0,0))-groebnerMatrix(1,13)/(groebnerMatrix(1,0)));
49 groebnerMatrix(30,14) = (groebnerMatrix(0,14)/(groebnerMatrix(0,0))-groebnerMatrix(1,14)/(groebnerMatrix(1,0)));
50 groebnerMatrix(30,15) = (groebnerMatrix(0,15)/(groebnerMatrix(0,0))-groebnerMatrix(1,15)/(groebnerMatrix(1,0)));
51 groebnerMatrix(30,16) = (groebnerMatrix(0,16)/(groebnerMatrix(0,0))-groebnerMatrix(1,16)/(groebnerMatrix(1,0)));
52 groebnerMatrix(30,18) = (groebnerMatrix(0,18)/(groebnerMatrix(0,0))-groebnerMatrix(1,18)/(groebnerMatrix(1,0)));
53 groebnerMatrix(30,19) = (groebnerMatrix(0,19)/(groebnerMatrix(0,0))-groebnerMatrix(1,19)/(groebnerMatrix(1,0)));
54 groebnerMatrix(30,20) = (groebnerMatrix(0,20)/(groebnerMatrix(0,0))-groebnerMatrix(1,20)/(groebnerMatrix(1,0)));
55 groebnerMatrix(30,21) = (groebnerMatrix(0,21)/(groebnerMatrix(0,0))-groebnerMatrix(1,21)/(groebnerMatrix(1,0)));
56 groebnerMatrix(30,22) = (groebnerMatrix(0,22)/(groebnerMatrix(0,0))-groebnerMatrix(1,22)/(groebnerMatrix(1,0)));
57 groebnerMatrix(30,23) = (groebnerMatrix(0,23)/(groebnerMatrix(0,0))-groebnerMatrix(1,23)/(groebnerMatrix(1,0)));
58 groebnerMatrix(30,25) = (groebnerMatrix(0,25)/(groebnerMatrix(0,0))-groebnerMatrix(1,25)/(groebnerMatrix(1,0)));
59 groebnerMatrix(30,26) = (groebnerMatrix(0,26)/(groebnerMatrix(0,0))-groebnerMatrix(1,26)/(groebnerMatrix(1,0)));
60 groebnerMatrix(30,27) = (groebnerMatrix(0,27)/(groebnerMatrix(0,0))-groebnerMatrix(1,27)/(groebnerMatrix(1,0)));
61 groebnerMatrix(30,28) = (groebnerMatrix(0,28)/(groebnerMatrix(0,0))-groebnerMatrix(1,28)/(groebnerMatrix(1,0)));
62 groebnerMatrix(30,29) = (groebnerMatrix(0,29)/(groebnerMatrix(0,0))-groebnerMatrix(1,29)/(groebnerMatrix(1,0)));
63 groebnerMatrix(30,30) = (groebnerMatrix(0,30)/(groebnerMatrix(0,0))-groebnerMatrix(1,30)/(groebnerMatrix(1,0)));
64 groebnerMatrix(30,33) = (groebnerMatrix(0,33)/(groebnerMatrix(0,0))-groebnerMatrix(1,33)/(groebnerMatrix(1,0)));
65 groebnerMatrix(30,34) = (groebnerMatrix(0,34)/(groebnerMatrix(0,0))-groebnerMatrix(1,34)/(groebnerMatrix(1,0)));
66 groebnerMatrix(30,39) = (groebnerMatrix(0,39)/(groebnerMatrix(0,0))-groebnerMatrix(1,39)/(groebnerMatrix(1,0)));
67 groebnerMatrix(30,40) = (groebnerMatrix(0,40)/(groebnerMatrix(0,0))-groebnerMatrix(1,40)/(groebnerMatrix(1,0)));
68 groebnerMatrix(30,41) = (groebnerMatrix(0,41)/(groebnerMatrix(0,0))-groebnerMatrix(1,41)/(groebnerMatrix(1,0)));
69 groebnerMatrix(30,42) = (groebnerMatrix(0,42)/(groebnerMatrix(0,0))-groebnerMatrix(1,42)/(groebnerMatrix(1,0)));
70 groebnerMatrix(30,43) = (groebnerMatrix(0,43)/(groebnerMatrix(0,0))-groebnerMatrix(1,43)/(groebnerMatrix(1,0)));
71 groebnerMatrix(30,44) = (groebnerMatrix(0,44)/(groebnerMatrix(0,0))-groebnerMatrix(1,44)/(groebnerMatrix(1,0)));
72 groebnerMatrix(30,45) = (groebnerMatrix(0,45)/(groebnerMatrix(0,0))-groebnerMatrix(1,45)/(groebnerMatrix(1,0)));
73 groebnerMatrix(30,46) = (groebnerMatrix(0,46)/(groebnerMatrix(0,0))-groebnerMatrix(1,46)/(groebnerMatrix(1,0)));
74 groebnerMatrix(30,47) = (groebnerMatrix(0,47)/(groebnerMatrix(0,0))-groebnerMatrix(1,47)/(groebnerMatrix(1,0)));
75 groebnerMatrix(30,48) = (groebnerMatrix(0,48)/(groebnerMatrix(0,0))-groebnerMatrix(1,48)/(groebnerMatrix(1,0)));
76 groebnerMatrix(30,49) = (groebnerMatrix(0,49)/(groebnerMatrix(0,0))-groebnerMatrix(1,49)/(groebnerMatrix(1,0)));
77 groebnerMatrix(30,50) = (groebnerMatrix(0,50)/(groebnerMatrix(0,0))-groebnerMatrix(1,50)/(groebnerMatrix(1,0)));
78 groebnerMatrix(30,51) = (groebnerMatrix(0,51)/(groebnerMatrix(0,0))-groebnerMatrix(1,51)/(groebnerMatrix(1,0)));
79 groebnerMatrix(30,52) = (groebnerMatrix(0,52)/(groebnerMatrix(0,0))-groebnerMatrix(1,52)/(groebnerMatrix(1,0)));
80 groebnerMatrix(30,53) = (groebnerMatrix(0,53)/(groebnerMatrix(0,0))-groebnerMatrix(1,53)/(groebnerMatrix(1,0)));
81 groebnerMatrix(30,54) = (groebnerMatrix(0,54)/(groebnerMatrix(0,0))-groebnerMatrix(1,54)/(groebnerMatrix(1,0)));
82 groebnerMatrix(30,55) = (groebnerMatrix(0,55)/(groebnerMatrix(0,0))-groebnerMatrix(1,55)/(groebnerMatrix(1,0)));
83 groebnerMatrix(30,56) = (groebnerMatrix(0,56)/(groebnerMatrix(0,0))-groebnerMatrix(1,56)/(groebnerMatrix(1,0)));
84 groebnerMatrix(30,57) = (groebnerMatrix(0,57)/(groebnerMatrix(0,0))-groebnerMatrix(1,57)/(groebnerMatrix(1,0)));
85 groebnerMatrix(30,58) = (groebnerMatrix(0,58)/(groebnerMatrix(0,0))-groebnerMatrix(1,58)/(groebnerMatrix(1,0)));
86 groebnerMatrix(30,59) = (groebnerMatrix(0,59)/(groebnerMatrix(0,0))-groebnerMatrix(1,59)/(groebnerMatrix(1,0)));
87 groebnerMatrix(30,60) = (groebnerMatrix(0,60)/(groebnerMatrix(0,0))-groebnerMatrix(1,60)/(groebnerMatrix(1,0)));
88 groebnerMatrix(30,61) = (groebnerMatrix(0,61)/(groebnerMatrix(0,0))-groebnerMatrix(1,61)/(groebnerMatrix(1,0)));
89 groebnerMatrix(30,62) = (groebnerMatrix(0,62)/(groebnerMatrix(0,0))-groebnerMatrix(1,62)/(groebnerMatrix(1,0)));
90 groebnerMatrix(30,64) = (groebnerMatrix(0,64)/(groebnerMatrix(0,0))-groebnerMatrix(1,64)/(groebnerMatrix(1,0)));
91 groebnerMatrix(30,65) = (groebnerMatrix(0,65)/(groebnerMatrix(0,0))-groebnerMatrix(1,65)/(groebnerMatrix(1,0)));
92 groebnerMatrix(30,66) = (groebnerMatrix(0,66)/(groebnerMatrix(0,0))-groebnerMatrix(1,66)/(groebnerMatrix(1,0)));
93 groebnerMatrix(30,67) = (groebnerMatrix(0,67)/(groebnerMatrix(0,0))-groebnerMatrix(1,67)/(groebnerMatrix(1,0)));
94 groebnerMatrix(30,68) = (groebnerMatrix(0,68)/(groebnerMatrix(0,0))-groebnerMatrix(1,68)/(groebnerMatrix(1,0)));
95 groebnerMatrix(30,69) = (groebnerMatrix(0,69)/(groebnerMatrix(0,0))-groebnerMatrix(1,69)/(groebnerMatrix(1,0)));
96 groebnerMatrix(30,70) = (groebnerMatrix(0,70)/(groebnerMatrix(0,0))-groebnerMatrix(1,70)/(groebnerMatrix(1,0)));
97 groebnerMatrix(30,71) = (groebnerMatrix(0,71)/(groebnerMatrix(0,0))-groebnerMatrix(1,71)/(groebnerMatrix(1,0)));
98 groebnerMatrix(30,73) = (groebnerMatrix(0,73)/(groebnerMatrix(0,0))-groebnerMatrix(1,73)/(groebnerMatrix(1,0)));
99 groebnerMatrix(30,74) = (groebnerMatrix(0,74)/(groebnerMatrix(0,0))-groebnerMatrix(1,74)/(groebnerMatrix(1,0)));
100 groebnerMatrix(30,76) = (groebnerMatrix(0,76)/(groebnerMatrix(0,0))-groebnerMatrix(1,76)/(groebnerMatrix(1,0)));
101 groebnerMatrix(30,77) = (groebnerMatrix(0,77)/(groebnerMatrix(0,0))-groebnerMatrix(1,77)/(groebnerMatrix(1,0)));
102 groebnerMatrix(30,78) = (groebnerMatrix(0,78)/(groebnerMatrix(0,0))-groebnerMatrix(1,78)/(groebnerMatrix(1,0)));
103 groebnerMatrix(30,79) = (groebnerMatrix(0,79)/(groebnerMatrix(0,0))-groebnerMatrix(1,79)/(groebnerMatrix(1,0)));
104 groebnerMatrix(30,80) = (groebnerMatrix(0,80)/(groebnerMatrix(0,0))-groebnerMatrix(1,80)/(groebnerMatrix(1,0)));
105 groebnerMatrix(30,81) = (groebnerMatrix(0,81)/(groebnerMatrix(0,0))-groebnerMatrix(1,81)/(groebnerMatrix(1,0)));
106 groebnerMatrix(30,82) = (groebnerMatrix(0,82)/(groebnerMatrix(0,0))-groebnerMatrix(1,82)/(groebnerMatrix(1,0)));
107 groebnerMatrix(30,83) = (groebnerMatrix(0,83)/(groebnerMatrix(0,0))-groebnerMatrix(1,83)/(groebnerMatrix(1,0)));
108 groebnerMatrix(30,84) = (groebnerMatrix(0,84)/(groebnerMatrix(0,0))-groebnerMatrix(1,84)/(groebnerMatrix(1,0)));
109 groebnerMatrix(30,85) = (groebnerMatrix(0,85)/(groebnerMatrix(0,0))-groebnerMatrix(1,85)/(groebnerMatrix(1,0)));
110 groebnerMatrix(30,86) = (groebnerMatrix(0,86)/(groebnerMatrix(0,0))-groebnerMatrix(1,86)/(groebnerMatrix(1,0)));
111 groebnerMatrix(30,87) = (groebnerMatrix(0,87)/(groebnerMatrix(0,0))-groebnerMatrix(1,87)/(groebnerMatrix(1,0)));
112 groebnerMatrix(30,89) = (groebnerMatrix(0,89)/(groebnerMatrix(0,0))-groebnerMatrix(1,89)/(groebnerMatrix(1,0)));
113 groebnerMatrix(30,91) = (groebnerMatrix(0,91)/(groebnerMatrix(0,0))-groebnerMatrix(1,91)/(groebnerMatrix(1,0)));
114 groebnerMatrix(30,92) = (groebnerMatrix(0,92)/(groebnerMatrix(0,0))-groebnerMatrix(1,92)/(groebnerMatrix(1,0)));
115 groebnerMatrix(30,94) = (groebnerMatrix(0,94)/(groebnerMatrix(0,0))-groebnerMatrix(1,94)/(groebnerMatrix(1,0)));
116 groebnerMatrix(30,97) = (groebnerMatrix(0,97)/(groebnerMatrix(0,0))-groebnerMatrix(1,97)/(groebnerMatrix(1,0)));
117 groebnerMatrix(30,98) = (groebnerMatrix(0,98)/(groebnerMatrix(0,0))-groebnerMatrix(1,98)/(groebnerMatrix(1,0)));
118 groebnerMatrix(30,99) = (groebnerMatrix(0,99)/(groebnerMatrix(0,0))-groebnerMatrix(1,99)/(groebnerMatrix(1,0)));
119 groebnerMatrix(30,100) = (groebnerMatrix(0,100)/(groebnerMatrix(0,0))-groebnerMatrix(1,100)/(groebnerMatrix(1,0)));
120 groebnerMatrix(30,101) = (groebnerMatrix(0,101)/(groebnerMatrix(0,0))-groebnerMatrix(1,101)/(groebnerMatrix(1,0)));
121 groebnerMatrix(30,103) = (groebnerMatrix(0,103)/(groebnerMatrix(0,0))-groebnerMatrix(1,103)/(groebnerMatrix(1,0)));
122 groebnerMatrix(30,104) = (groebnerMatrix(0,104)/(groebnerMatrix(0,0))-groebnerMatrix(1,104)/(groebnerMatrix(1,0)));
123 groebnerMatrix(30,105) = (groebnerMatrix(0,105)/(groebnerMatrix(0,0))-groebnerMatrix(1,105)/(groebnerMatrix(1,0)));
124 groebnerMatrix(30,106) = (groebnerMatrix(0,106)/(groebnerMatrix(0,0))-groebnerMatrix(1,106)/(groebnerMatrix(1,0)));
125 groebnerMatrix(30,107) = (groebnerMatrix(0,107)/(groebnerMatrix(0,0))-groebnerMatrix(1,107)/(groebnerMatrix(1,0)));
126 groebnerMatrix(30,108) = (groebnerMatrix(0,108)/(groebnerMatrix(0,0))-groebnerMatrix(1,108)/(groebnerMatrix(1,0)));
127 groebnerMatrix(30,109) = (groebnerMatrix(0,109)/(groebnerMatrix(0,0))-groebnerMatrix(1,109)/(groebnerMatrix(1,0)));
128 groebnerMatrix(30,110) = (groebnerMatrix(0,110)/(groebnerMatrix(0,0))-groebnerMatrix(1,110)/(groebnerMatrix(1,0)));
129 groebnerMatrix(30,111) = (groebnerMatrix(0,111)/(groebnerMatrix(0,0))-groebnerMatrix(1,111)/(groebnerMatrix(1,0)));
130 groebnerMatrix(30,112) = (groebnerMatrix(0,112)/(groebnerMatrix(0,0))-groebnerMatrix(1,112)/(groebnerMatrix(1,0)));
131 groebnerMatrix(30,113) = (groebnerMatrix(0,113)/(groebnerMatrix(0,0))-groebnerMatrix(1,113)/(groebnerMatrix(1,0)));
132 groebnerMatrix(30,115) = (groebnerMatrix(0,115)/(groebnerMatrix(0,0))-groebnerMatrix(1,115)/(groebnerMatrix(1,0)));
133 groebnerMatrix(30,116) = (groebnerMatrix(0,116)/(groebnerMatrix(0,0))-groebnerMatrix(1,116)/(groebnerMatrix(1,0)));
134 groebnerMatrix(30,118) = (groebnerMatrix(0,118)/(groebnerMatrix(0,0))-groebnerMatrix(1,118)/(groebnerMatrix(1,0)));
135 groebnerMatrix(30,119) = (groebnerMatrix(0,119)/(groebnerMatrix(0,0))-groebnerMatrix(1,119)/(groebnerMatrix(1,0)));
136 groebnerMatrix(30,120) = (groebnerMatrix(0,120)/(groebnerMatrix(0,0))-groebnerMatrix(1,120)/(groebnerMatrix(1,0)));
137 groebnerMatrix(30,121) = (groebnerMatrix(0,121)/(groebnerMatrix(0,0))-groebnerMatrix(1,121)/(groebnerMatrix(1,0)));
138 groebnerMatrix(30,122) = (groebnerMatrix(0,122)/(groebnerMatrix(0,0))-groebnerMatrix(1,122)/(groebnerMatrix(1,0)));
139 groebnerMatrix(30,123) = (groebnerMatrix(0,123)/(groebnerMatrix(0,0))-groebnerMatrix(1,123)/(groebnerMatrix(1,0)));
140 groebnerMatrix(30,125) = (groebnerMatrix(0,125)/(groebnerMatrix(0,0))-groebnerMatrix(1,125)/(groebnerMatrix(1,0)));
141 groebnerMatrix(30,126) = (groebnerMatrix(0,126)/(groebnerMatrix(0,0))-groebnerMatrix(1,126)/(groebnerMatrix(1,0)));
142 groebnerMatrix(30,127) = (groebnerMatrix(0,127)/(groebnerMatrix(0,0))-groebnerMatrix(1,127)/(groebnerMatrix(1,0)));
143 groebnerMatrix(30,128) = (groebnerMatrix(0,128)/(groebnerMatrix(0,0))-groebnerMatrix(1,128)/(groebnerMatrix(1,0)));
144 groebnerMatrix(30,129) = (groebnerMatrix(0,129)/(groebnerMatrix(0,0))-groebnerMatrix(1,129)/(groebnerMatrix(1,0)));
145 groebnerMatrix(30,130) = (groebnerMatrix(0,130)/(groebnerMatrix(0,0))-groebnerMatrix(1,130)/(groebnerMatrix(1,0)));
146 groebnerMatrix(30,133) = (groebnerMatrix(0,133)/(groebnerMatrix(0,0))-groebnerMatrix(1,133)/(groebnerMatrix(1,0)));
147 groebnerMatrix(30,134) = (groebnerMatrix(0,134)/(groebnerMatrix(0,0))-groebnerMatrix(1,134)/(groebnerMatrix(1,0)));
148 groebnerMatrix(30,136) = (groebnerMatrix(0,136)/(groebnerMatrix(0,0))-groebnerMatrix(1,136)/(groebnerMatrix(1,0)));
149 groebnerMatrix(30,137) = (groebnerMatrix(0,137)/(groebnerMatrix(0,0))-groebnerMatrix(1,137)/(groebnerMatrix(1,0)));
150 }
151
152 void
sPolynomial31(Eigen::Matrix<double,66,197> & groebnerMatrix)153 opengv::relative_pose::modules::fivept_kneip::sPolynomial31( Eigen::Matrix<double,66,197> & groebnerMatrix )
154 {
155 groebnerMatrix(31,1) = (groebnerMatrix(1,1)/(groebnerMatrix(1,0))-groebnerMatrix(2,1)/(groebnerMatrix(2,0)));
156 groebnerMatrix(31,2) = (groebnerMatrix(1,2)/(groebnerMatrix(1,0))-groebnerMatrix(2,2)/(groebnerMatrix(2,0)));
157 groebnerMatrix(31,3) = (groebnerMatrix(1,3)/(groebnerMatrix(1,0))-groebnerMatrix(2,3)/(groebnerMatrix(2,0)));
158 groebnerMatrix(31,4) = (groebnerMatrix(1,4)/(groebnerMatrix(1,0))-groebnerMatrix(2,4)/(groebnerMatrix(2,0)));
159 groebnerMatrix(31,5) = (groebnerMatrix(1,5)/(groebnerMatrix(1,0))-groebnerMatrix(2,5)/(groebnerMatrix(2,0)));
160 groebnerMatrix(31,6) = (groebnerMatrix(1,6)/(groebnerMatrix(1,0))-groebnerMatrix(2,6)/(groebnerMatrix(2,0)));
161 groebnerMatrix(31,8) = (groebnerMatrix(1,8)/(groebnerMatrix(1,0))-groebnerMatrix(2,8)/(groebnerMatrix(2,0)));
162 groebnerMatrix(31,10) = (groebnerMatrix(1,10)/(groebnerMatrix(1,0))-groebnerMatrix(2,10)/(groebnerMatrix(2,0)));
163 groebnerMatrix(31,11) = (groebnerMatrix(1,11)/(groebnerMatrix(1,0))-groebnerMatrix(2,11)/(groebnerMatrix(2,0)));
164 groebnerMatrix(31,12) = (groebnerMatrix(1,12)/(groebnerMatrix(1,0))-groebnerMatrix(2,12)/(groebnerMatrix(2,0)));
165 groebnerMatrix(31,13) = (groebnerMatrix(1,13)/(groebnerMatrix(1,0))-groebnerMatrix(2,13)/(groebnerMatrix(2,0)));
166 groebnerMatrix(31,14) = (groebnerMatrix(1,14)/(groebnerMatrix(1,0))-groebnerMatrix(2,14)/(groebnerMatrix(2,0)));
167 groebnerMatrix(31,15) = (groebnerMatrix(1,15)/(groebnerMatrix(1,0))-groebnerMatrix(2,15)/(groebnerMatrix(2,0)));
168 groebnerMatrix(31,16) = (groebnerMatrix(1,16)/(groebnerMatrix(1,0))-groebnerMatrix(2,16)/(groebnerMatrix(2,0)));
169 groebnerMatrix(31,18) = (groebnerMatrix(1,18)/(groebnerMatrix(1,0))-groebnerMatrix(2,18)/(groebnerMatrix(2,0)));
170 groebnerMatrix(31,19) = (groebnerMatrix(1,19)/(groebnerMatrix(1,0))-groebnerMatrix(2,19)/(groebnerMatrix(2,0)));
171 groebnerMatrix(31,20) = (groebnerMatrix(1,20)/(groebnerMatrix(1,0))-groebnerMatrix(2,20)/(groebnerMatrix(2,0)));
172 groebnerMatrix(31,21) = (groebnerMatrix(1,21)/(groebnerMatrix(1,0))-groebnerMatrix(2,21)/(groebnerMatrix(2,0)));
173 groebnerMatrix(31,22) = (groebnerMatrix(1,22)/(groebnerMatrix(1,0))-groebnerMatrix(2,22)/(groebnerMatrix(2,0)));
174 groebnerMatrix(31,23) = (groebnerMatrix(1,23)/(groebnerMatrix(1,0))-groebnerMatrix(2,23)/(groebnerMatrix(2,0)));
175 groebnerMatrix(31,25) = (groebnerMatrix(1,25)/(groebnerMatrix(1,0))-groebnerMatrix(2,25)/(groebnerMatrix(2,0)));
176 groebnerMatrix(31,26) = (groebnerMatrix(1,26)/(groebnerMatrix(1,0))-groebnerMatrix(2,26)/(groebnerMatrix(2,0)));
177 groebnerMatrix(31,27) = (groebnerMatrix(1,27)/(groebnerMatrix(1,0))-groebnerMatrix(2,27)/(groebnerMatrix(2,0)));
178 groebnerMatrix(31,28) = (groebnerMatrix(1,28)/(groebnerMatrix(1,0))-groebnerMatrix(2,28)/(groebnerMatrix(2,0)));
179 groebnerMatrix(31,29) = (groebnerMatrix(1,29)/(groebnerMatrix(1,0))-groebnerMatrix(2,29)/(groebnerMatrix(2,0)));
180 groebnerMatrix(31,30) = (groebnerMatrix(1,30)/(groebnerMatrix(1,0))-groebnerMatrix(2,30)/(groebnerMatrix(2,0)));
181 groebnerMatrix(31,33) = (groebnerMatrix(1,33)/(groebnerMatrix(1,0))-groebnerMatrix(2,33)/(groebnerMatrix(2,0)));
182 groebnerMatrix(31,34) = (groebnerMatrix(1,34)/(groebnerMatrix(1,0))-groebnerMatrix(2,34)/(groebnerMatrix(2,0)));
183 groebnerMatrix(31,39) = (groebnerMatrix(1,39)/(groebnerMatrix(1,0))-groebnerMatrix(2,39)/(groebnerMatrix(2,0)));
184 groebnerMatrix(31,40) = (groebnerMatrix(1,40)/(groebnerMatrix(1,0))-groebnerMatrix(2,40)/(groebnerMatrix(2,0)));
185 groebnerMatrix(31,41) = (groebnerMatrix(1,41)/(groebnerMatrix(1,0))-groebnerMatrix(2,41)/(groebnerMatrix(2,0)));
186 groebnerMatrix(31,42) = (groebnerMatrix(1,42)/(groebnerMatrix(1,0))-groebnerMatrix(2,42)/(groebnerMatrix(2,0)));
187 groebnerMatrix(31,43) = (groebnerMatrix(1,43)/(groebnerMatrix(1,0))-groebnerMatrix(2,43)/(groebnerMatrix(2,0)));
188 groebnerMatrix(31,44) = (groebnerMatrix(1,44)/(groebnerMatrix(1,0))-groebnerMatrix(2,44)/(groebnerMatrix(2,0)));
189 groebnerMatrix(31,45) = (groebnerMatrix(1,45)/(groebnerMatrix(1,0))-groebnerMatrix(2,45)/(groebnerMatrix(2,0)));
190 groebnerMatrix(31,46) = (groebnerMatrix(1,46)/(groebnerMatrix(1,0))-groebnerMatrix(2,46)/(groebnerMatrix(2,0)));
191 groebnerMatrix(31,47) = (groebnerMatrix(1,47)/(groebnerMatrix(1,0))-groebnerMatrix(2,47)/(groebnerMatrix(2,0)));
192 groebnerMatrix(31,48) = (groebnerMatrix(1,48)/(groebnerMatrix(1,0))-groebnerMatrix(2,48)/(groebnerMatrix(2,0)));
193 groebnerMatrix(31,49) = (groebnerMatrix(1,49)/(groebnerMatrix(1,0))-groebnerMatrix(2,49)/(groebnerMatrix(2,0)));
194 groebnerMatrix(31,50) = (groebnerMatrix(1,50)/(groebnerMatrix(1,0))-groebnerMatrix(2,50)/(groebnerMatrix(2,0)));
195 groebnerMatrix(31,51) = (groebnerMatrix(1,51)/(groebnerMatrix(1,0))-groebnerMatrix(2,51)/(groebnerMatrix(2,0)));
196 groebnerMatrix(31,52) = (groebnerMatrix(1,52)/(groebnerMatrix(1,0))-groebnerMatrix(2,52)/(groebnerMatrix(2,0)));
197 groebnerMatrix(31,53) = (groebnerMatrix(1,53)/(groebnerMatrix(1,0))-groebnerMatrix(2,53)/(groebnerMatrix(2,0)));
198 groebnerMatrix(31,54) = (groebnerMatrix(1,54)/(groebnerMatrix(1,0))-groebnerMatrix(2,54)/(groebnerMatrix(2,0)));
199 groebnerMatrix(31,55) = (groebnerMatrix(1,55)/(groebnerMatrix(1,0))-groebnerMatrix(2,55)/(groebnerMatrix(2,0)));
200 groebnerMatrix(31,56) = (groebnerMatrix(1,56)/(groebnerMatrix(1,0))-groebnerMatrix(2,56)/(groebnerMatrix(2,0)));
201 groebnerMatrix(31,57) = (groebnerMatrix(1,57)/(groebnerMatrix(1,0))-groebnerMatrix(2,57)/(groebnerMatrix(2,0)));
202 groebnerMatrix(31,58) = (groebnerMatrix(1,58)/(groebnerMatrix(1,0))-groebnerMatrix(2,58)/(groebnerMatrix(2,0)));
203 groebnerMatrix(31,59) = (groebnerMatrix(1,59)/(groebnerMatrix(1,0))-groebnerMatrix(2,59)/(groebnerMatrix(2,0)));
204 groebnerMatrix(31,60) = (groebnerMatrix(1,60)/(groebnerMatrix(1,0))-groebnerMatrix(2,60)/(groebnerMatrix(2,0)));
205 groebnerMatrix(31,61) = (groebnerMatrix(1,61)/(groebnerMatrix(1,0))-groebnerMatrix(2,61)/(groebnerMatrix(2,0)));
206 groebnerMatrix(31,62) = (groebnerMatrix(1,62)/(groebnerMatrix(1,0))-groebnerMatrix(2,62)/(groebnerMatrix(2,0)));
207 groebnerMatrix(31,64) = (groebnerMatrix(1,64)/(groebnerMatrix(1,0))-groebnerMatrix(2,64)/(groebnerMatrix(2,0)));
208 groebnerMatrix(31,65) = (groebnerMatrix(1,65)/(groebnerMatrix(1,0))-groebnerMatrix(2,65)/(groebnerMatrix(2,0)));
209 groebnerMatrix(31,66) = (groebnerMatrix(1,66)/(groebnerMatrix(1,0))-groebnerMatrix(2,66)/(groebnerMatrix(2,0)));
210 groebnerMatrix(31,67) = (groebnerMatrix(1,67)/(groebnerMatrix(1,0))-groebnerMatrix(2,67)/(groebnerMatrix(2,0)));
211 groebnerMatrix(31,68) = (groebnerMatrix(1,68)/(groebnerMatrix(1,0))-groebnerMatrix(2,68)/(groebnerMatrix(2,0)));
212 groebnerMatrix(31,69) = (groebnerMatrix(1,69)/(groebnerMatrix(1,0))-groebnerMatrix(2,69)/(groebnerMatrix(2,0)));
213 groebnerMatrix(31,70) = (groebnerMatrix(1,70)/(groebnerMatrix(1,0))-groebnerMatrix(2,70)/(groebnerMatrix(2,0)));
214 groebnerMatrix(31,71) = (groebnerMatrix(1,71)/(groebnerMatrix(1,0))-groebnerMatrix(2,71)/(groebnerMatrix(2,0)));
215 groebnerMatrix(31,73) = (groebnerMatrix(1,73)/(groebnerMatrix(1,0))-groebnerMatrix(2,73)/(groebnerMatrix(2,0)));
216 groebnerMatrix(31,74) = (groebnerMatrix(1,74)/(groebnerMatrix(1,0))-groebnerMatrix(2,74)/(groebnerMatrix(2,0)));
217 groebnerMatrix(31,76) = (groebnerMatrix(1,76)/(groebnerMatrix(1,0))-groebnerMatrix(2,76)/(groebnerMatrix(2,0)));
218 groebnerMatrix(31,77) = (groebnerMatrix(1,77)/(groebnerMatrix(1,0))-groebnerMatrix(2,77)/(groebnerMatrix(2,0)));
219 groebnerMatrix(31,78) = (groebnerMatrix(1,78)/(groebnerMatrix(1,0))-groebnerMatrix(2,78)/(groebnerMatrix(2,0)));
220 groebnerMatrix(31,79) = (groebnerMatrix(1,79)/(groebnerMatrix(1,0))-groebnerMatrix(2,79)/(groebnerMatrix(2,0)));
221 groebnerMatrix(31,80) = (groebnerMatrix(1,80)/(groebnerMatrix(1,0))-groebnerMatrix(2,80)/(groebnerMatrix(2,0)));
222 groebnerMatrix(31,81) = (groebnerMatrix(1,81)/(groebnerMatrix(1,0))-groebnerMatrix(2,81)/(groebnerMatrix(2,0)));
223 groebnerMatrix(31,82) = (groebnerMatrix(1,82)/(groebnerMatrix(1,0))-groebnerMatrix(2,82)/(groebnerMatrix(2,0)));
224 groebnerMatrix(31,83) = (groebnerMatrix(1,83)/(groebnerMatrix(1,0))-groebnerMatrix(2,83)/(groebnerMatrix(2,0)));
225 groebnerMatrix(31,84) = (groebnerMatrix(1,84)/(groebnerMatrix(1,0))-groebnerMatrix(2,84)/(groebnerMatrix(2,0)));
226 groebnerMatrix(31,85) = (groebnerMatrix(1,85)/(groebnerMatrix(1,0))-groebnerMatrix(2,85)/(groebnerMatrix(2,0)));
227 groebnerMatrix(31,86) = (groebnerMatrix(1,86)/(groebnerMatrix(1,0))-groebnerMatrix(2,86)/(groebnerMatrix(2,0)));
228 groebnerMatrix(31,87) = (groebnerMatrix(1,87)/(groebnerMatrix(1,0))-groebnerMatrix(2,87)/(groebnerMatrix(2,0)));
229 groebnerMatrix(31,89) = (groebnerMatrix(1,89)/(groebnerMatrix(1,0))-groebnerMatrix(2,89)/(groebnerMatrix(2,0)));
230 groebnerMatrix(31,91) = (groebnerMatrix(1,91)/(groebnerMatrix(1,0))-groebnerMatrix(2,91)/(groebnerMatrix(2,0)));
231 groebnerMatrix(31,92) = (groebnerMatrix(1,92)/(groebnerMatrix(1,0))-groebnerMatrix(2,92)/(groebnerMatrix(2,0)));
232 groebnerMatrix(31,94) = (groebnerMatrix(1,94)/(groebnerMatrix(1,0))-groebnerMatrix(2,94)/(groebnerMatrix(2,0)));
233 groebnerMatrix(31,97) = (groebnerMatrix(1,97)/(groebnerMatrix(1,0))-groebnerMatrix(2,97)/(groebnerMatrix(2,0)));
234 groebnerMatrix(31,98) = (groebnerMatrix(1,98)/(groebnerMatrix(1,0))-groebnerMatrix(2,98)/(groebnerMatrix(2,0)));
235 groebnerMatrix(31,99) = (groebnerMatrix(1,99)/(groebnerMatrix(1,0))-groebnerMatrix(2,99)/(groebnerMatrix(2,0)));
236 groebnerMatrix(31,100) = (groebnerMatrix(1,100)/(groebnerMatrix(1,0))-groebnerMatrix(2,100)/(groebnerMatrix(2,0)));
237 groebnerMatrix(31,101) = (groebnerMatrix(1,101)/(groebnerMatrix(1,0))-groebnerMatrix(2,101)/(groebnerMatrix(2,0)));
238 groebnerMatrix(31,103) = (groebnerMatrix(1,103)/(groebnerMatrix(1,0))-groebnerMatrix(2,103)/(groebnerMatrix(2,0)));
239 groebnerMatrix(31,104) = (groebnerMatrix(1,104)/(groebnerMatrix(1,0))-groebnerMatrix(2,104)/(groebnerMatrix(2,0)));
240 groebnerMatrix(31,105) = (groebnerMatrix(1,105)/(groebnerMatrix(1,0))-groebnerMatrix(2,105)/(groebnerMatrix(2,0)));
241 groebnerMatrix(31,106) = (groebnerMatrix(1,106)/(groebnerMatrix(1,0))-groebnerMatrix(2,106)/(groebnerMatrix(2,0)));
242 groebnerMatrix(31,107) = (groebnerMatrix(1,107)/(groebnerMatrix(1,0))-groebnerMatrix(2,107)/(groebnerMatrix(2,0)));
243 groebnerMatrix(31,108) = (groebnerMatrix(1,108)/(groebnerMatrix(1,0))-groebnerMatrix(2,108)/(groebnerMatrix(2,0)));
244 groebnerMatrix(31,109) = (groebnerMatrix(1,109)/(groebnerMatrix(1,0))-groebnerMatrix(2,109)/(groebnerMatrix(2,0)));
245 groebnerMatrix(31,110) = (groebnerMatrix(1,110)/(groebnerMatrix(1,0))-groebnerMatrix(2,110)/(groebnerMatrix(2,0)));
246 groebnerMatrix(31,111) = (groebnerMatrix(1,111)/(groebnerMatrix(1,0))-groebnerMatrix(2,111)/(groebnerMatrix(2,0)));
247 groebnerMatrix(31,112) = (groebnerMatrix(1,112)/(groebnerMatrix(1,0))-groebnerMatrix(2,112)/(groebnerMatrix(2,0)));
248 groebnerMatrix(31,113) = (groebnerMatrix(1,113)/(groebnerMatrix(1,0))-groebnerMatrix(2,113)/(groebnerMatrix(2,0)));
249 groebnerMatrix(31,115) = (groebnerMatrix(1,115)/(groebnerMatrix(1,0))-groebnerMatrix(2,115)/(groebnerMatrix(2,0)));
250 groebnerMatrix(31,116) = (groebnerMatrix(1,116)/(groebnerMatrix(1,0))-groebnerMatrix(2,116)/(groebnerMatrix(2,0)));
251 groebnerMatrix(31,118) = (groebnerMatrix(1,118)/(groebnerMatrix(1,0))-groebnerMatrix(2,118)/(groebnerMatrix(2,0)));
252 groebnerMatrix(31,119) = (groebnerMatrix(1,119)/(groebnerMatrix(1,0))-groebnerMatrix(2,119)/(groebnerMatrix(2,0)));
253 groebnerMatrix(31,120) = (groebnerMatrix(1,120)/(groebnerMatrix(1,0))-groebnerMatrix(2,120)/(groebnerMatrix(2,0)));
254 groebnerMatrix(31,121) = (groebnerMatrix(1,121)/(groebnerMatrix(1,0))-groebnerMatrix(2,121)/(groebnerMatrix(2,0)));
255 groebnerMatrix(31,122) = (groebnerMatrix(1,122)/(groebnerMatrix(1,0))-groebnerMatrix(2,122)/(groebnerMatrix(2,0)));
256 groebnerMatrix(31,123) = (groebnerMatrix(1,123)/(groebnerMatrix(1,0))-groebnerMatrix(2,123)/(groebnerMatrix(2,0)));
257 groebnerMatrix(31,125) = (groebnerMatrix(1,125)/(groebnerMatrix(1,0))-groebnerMatrix(2,125)/(groebnerMatrix(2,0)));
258 groebnerMatrix(31,126) = (groebnerMatrix(1,126)/(groebnerMatrix(1,0))-groebnerMatrix(2,126)/(groebnerMatrix(2,0)));
259 groebnerMatrix(31,127) = (groebnerMatrix(1,127)/(groebnerMatrix(1,0))-groebnerMatrix(2,127)/(groebnerMatrix(2,0)));
260 groebnerMatrix(31,128) = (groebnerMatrix(1,128)/(groebnerMatrix(1,0))-groebnerMatrix(2,128)/(groebnerMatrix(2,0)));
261 groebnerMatrix(31,129) = (groebnerMatrix(1,129)/(groebnerMatrix(1,0))-groebnerMatrix(2,129)/(groebnerMatrix(2,0)));
262 groebnerMatrix(31,130) = (groebnerMatrix(1,130)/(groebnerMatrix(1,0))-groebnerMatrix(2,130)/(groebnerMatrix(2,0)));
263 groebnerMatrix(31,133) = (groebnerMatrix(1,133)/(groebnerMatrix(1,0))-groebnerMatrix(2,133)/(groebnerMatrix(2,0)));
264 groebnerMatrix(31,134) = (groebnerMatrix(1,134)/(groebnerMatrix(1,0))-groebnerMatrix(2,134)/(groebnerMatrix(2,0)));
265 groebnerMatrix(31,136) = (groebnerMatrix(1,136)/(groebnerMatrix(1,0))-groebnerMatrix(2,136)/(groebnerMatrix(2,0)));
266 groebnerMatrix(31,137) = (groebnerMatrix(1,137)/(groebnerMatrix(1,0))-groebnerMatrix(2,137)/(groebnerMatrix(2,0)));
267 }
268
269 void
sPolynomial32(Eigen::Matrix<double,66,197> & groebnerMatrix)270 opengv::relative_pose::modules::fivept_kneip::sPolynomial32( Eigen::Matrix<double,66,197> & groebnerMatrix )
271 {
272 groebnerMatrix(32,1) = (groebnerMatrix(2,1)/(groebnerMatrix(2,0))-groebnerMatrix(3,1)/(groebnerMatrix(3,0)));
273 groebnerMatrix(32,2) = (groebnerMatrix(2,2)/(groebnerMatrix(2,0))-groebnerMatrix(3,2)/(groebnerMatrix(3,0)));
274 groebnerMatrix(32,3) = (groebnerMatrix(2,3)/(groebnerMatrix(2,0))-groebnerMatrix(3,3)/(groebnerMatrix(3,0)));
275 groebnerMatrix(32,4) = (groebnerMatrix(2,4)/(groebnerMatrix(2,0))-groebnerMatrix(3,4)/(groebnerMatrix(3,0)));
276 groebnerMatrix(32,5) = (groebnerMatrix(2,5)/(groebnerMatrix(2,0))-groebnerMatrix(3,5)/(groebnerMatrix(3,0)));
277 groebnerMatrix(32,6) = (groebnerMatrix(2,6)/(groebnerMatrix(2,0))-groebnerMatrix(3,6)/(groebnerMatrix(3,0)));
278 groebnerMatrix(32,8) = (groebnerMatrix(2,8)/(groebnerMatrix(2,0))-groebnerMatrix(3,8)/(groebnerMatrix(3,0)));
279 groebnerMatrix(32,10) = (groebnerMatrix(2,10)/(groebnerMatrix(2,0))-groebnerMatrix(3,10)/(groebnerMatrix(3,0)));
280 groebnerMatrix(32,11) = (groebnerMatrix(2,11)/(groebnerMatrix(2,0))-groebnerMatrix(3,11)/(groebnerMatrix(3,0)));
281 groebnerMatrix(32,12) = (groebnerMatrix(2,12)/(groebnerMatrix(2,0))-groebnerMatrix(3,12)/(groebnerMatrix(3,0)));
282 groebnerMatrix(32,13) = (groebnerMatrix(2,13)/(groebnerMatrix(2,0))-groebnerMatrix(3,13)/(groebnerMatrix(3,0)));
283 groebnerMatrix(32,14) = (groebnerMatrix(2,14)/(groebnerMatrix(2,0))-groebnerMatrix(3,14)/(groebnerMatrix(3,0)));
284 groebnerMatrix(32,15) = (groebnerMatrix(2,15)/(groebnerMatrix(2,0))-groebnerMatrix(3,15)/(groebnerMatrix(3,0)));
285 groebnerMatrix(32,16) = (groebnerMatrix(2,16)/(groebnerMatrix(2,0))-groebnerMatrix(3,16)/(groebnerMatrix(3,0)));
286 groebnerMatrix(32,18) = (groebnerMatrix(2,18)/(groebnerMatrix(2,0))-groebnerMatrix(3,18)/(groebnerMatrix(3,0)));
287 groebnerMatrix(32,19) = (groebnerMatrix(2,19)/(groebnerMatrix(2,0))-groebnerMatrix(3,19)/(groebnerMatrix(3,0)));
288 groebnerMatrix(32,20) = (groebnerMatrix(2,20)/(groebnerMatrix(2,0))-groebnerMatrix(3,20)/(groebnerMatrix(3,0)));
289 groebnerMatrix(32,21) = (groebnerMatrix(2,21)/(groebnerMatrix(2,0))-groebnerMatrix(3,21)/(groebnerMatrix(3,0)));
290 groebnerMatrix(32,22) = (groebnerMatrix(2,22)/(groebnerMatrix(2,0))-groebnerMatrix(3,22)/(groebnerMatrix(3,0)));
291 groebnerMatrix(32,23) = (groebnerMatrix(2,23)/(groebnerMatrix(2,0))-groebnerMatrix(3,23)/(groebnerMatrix(3,0)));
292 groebnerMatrix(32,25) = (groebnerMatrix(2,25)/(groebnerMatrix(2,0))-groebnerMatrix(3,25)/(groebnerMatrix(3,0)));
293 groebnerMatrix(32,26) = (groebnerMatrix(2,26)/(groebnerMatrix(2,0))-groebnerMatrix(3,26)/(groebnerMatrix(3,0)));
294 groebnerMatrix(32,27) = (groebnerMatrix(2,27)/(groebnerMatrix(2,0))-groebnerMatrix(3,27)/(groebnerMatrix(3,0)));
295 groebnerMatrix(32,28) = (groebnerMatrix(2,28)/(groebnerMatrix(2,0))-groebnerMatrix(3,28)/(groebnerMatrix(3,0)));
296 groebnerMatrix(32,29) = (groebnerMatrix(2,29)/(groebnerMatrix(2,0))-groebnerMatrix(3,29)/(groebnerMatrix(3,0)));
297 groebnerMatrix(32,30) = (groebnerMatrix(2,30)/(groebnerMatrix(2,0))-groebnerMatrix(3,30)/(groebnerMatrix(3,0)));
298 groebnerMatrix(32,33) = (groebnerMatrix(2,33)/(groebnerMatrix(2,0))-groebnerMatrix(3,33)/(groebnerMatrix(3,0)));
299 groebnerMatrix(32,34) = (groebnerMatrix(2,34)/(groebnerMatrix(2,0))-groebnerMatrix(3,34)/(groebnerMatrix(3,0)));
300 groebnerMatrix(32,39) = (groebnerMatrix(2,39)/(groebnerMatrix(2,0))-groebnerMatrix(3,39)/(groebnerMatrix(3,0)));
301 groebnerMatrix(32,40) = (groebnerMatrix(2,40)/(groebnerMatrix(2,0))-groebnerMatrix(3,40)/(groebnerMatrix(3,0)));
302 groebnerMatrix(32,41) = (groebnerMatrix(2,41)/(groebnerMatrix(2,0))-groebnerMatrix(3,41)/(groebnerMatrix(3,0)));
303 groebnerMatrix(32,42) = (groebnerMatrix(2,42)/(groebnerMatrix(2,0))-groebnerMatrix(3,42)/(groebnerMatrix(3,0)));
304 groebnerMatrix(32,43) = (groebnerMatrix(2,43)/(groebnerMatrix(2,0))-groebnerMatrix(3,43)/(groebnerMatrix(3,0)));
305 groebnerMatrix(32,44) = (groebnerMatrix(2,44)/(groebnerMatrix(2,0))-groebnerMatrix(3,44)/(groebnerMatrix(3,0)));
306 groebnerMatrix(32,45) = (groebnerMatrix(2,45)/(groebnerMatrix(2,0))-groebnerMatrix(3,45)/(groebnerMatrix(3,0)));
307 groebnerMatrix(32,46) = (groebnerMatrix(2,46)/(groebnerMatrix(2,0))-groebnerMatrix(3,46)/(groebnerMatrix(3,0)));
308 groebnerMatrix(32,47) = (groebnerMatrix(2,47)/(groebnerMatrix(2,0))-groebnerMatrix(3,47)/(groebnerMatrix(3,0)));
309 groebnerMatrix(32,48) = (groebnerMatrix(2,48)/(groebnerMatrix(2,0))-groebnerMatrix(3,48)/(groebnerMatrix(3,0)));
310 groebnerMatrix(32,49) = (groebnerMatrix(2,49)/(groebnerMatrix(2,0))-groebnerMatrix(3,49)/(groebnerMatrix(3,0)));
311 groebnerMatrix(32,50) = (groebnerMatrix(2,50)/(groebnerMatrix(2,0))-groebnerMatrix(3,50)/(groebnerMatrix(3,0)));
312 groebnerMatrix(32,51) = (groebnerMatrix(2,51)/(groebnerMatrix(2,0))-groebnerMatrix(3,51)/(groebnerMatrix(3,0)));
313 groebnerMatrix(32,52) = (groebnerMatrix(2,52)/(groebnerMatrix(2,0))-groebnerMatrix(3,52)/(groebnerMatrix(3,0)));
314 groebnerMatrix(32,53) = (groebnerMatrix(2,53)/(groebnerMatrix(2,0))-groebnerMatrix(3,53)/(groebnerMatrix(3,0)));
315 groebnerMatrix(32,54) = (groebnerMatrix(2,54)/(groebnerMatrix(2,0))-groebnerMatrix(3,54)/(groebnerMatrix(3,0)));
316 groebnerMatrix(32,55) = (groebnerMatrix(2,55)/(groebnerMatrix(2,0))-groebnerMatrix(3,55)/(groebnerMatrix(3,0)));
317 groebnerMatrix(32,56) = (groebnerMatrix(2,56)/(groebnerMatrix(2,0))-groebnerMatrix(3,56)/(groebnerMatrix(3,0)));
318 groebnerMatrix(32,57) = (groebnerMatrix(2,57)/(groebnerMatrix(2,0))-groebnerMatrix(3,57)/(groebnerMatrix(3,0)));
319 groebnerMatrix(32,58) = (groebnerMatrix(2,58)/(groebnerMatrix(2,0))-groebnerMatrix(3,58)/(groebnerMatrix(3,0)));
320 groebnerMatrix(32,59) = (groebnerMatrix(2,59)/(groebnerMatrix(2,0))-groebnerMatrix(3,59)/(groebnerMatrix(3,0)));
321 groebnerMatrix(32,60) = (groebnerMatrix(2,60)/(groebnerMatrix(2,0))-groebnerMatrix(3,60)/(groebnerMatrix(3,0)));
322 groebnerMatrix(32,61) = (groebnerMatrix(2,61)/(groebnerMatrix(2,0))-groebnerMatrix(3,61)/(groebnerMatrix(3,0)));
323 groebnerMatrix(32,62) = (groebnerMatrix(2,62)/(groebnerMatrix(2,0))-groebnerMatrix(3,62)/(groebnerMatrix(3,0)));
324 groebnerMatrix(32,64) = (groebnerMatrix(2,64)/(groebnerMatrix(2,0))-groebnerMatrix(3,64)/(groebnerMatrix(3,0)));
325 groebnerMatrix(32,65) = (groebnerMatrix(2,65)/(groebnerMatrix(2,0))-groebnerMatrix(3,65)/(groebnerMatrix(3,0)));
326 groebnerMatrix(32,66) = (groebnerMatrix(2,66)/(groebnerMatrix(2,0))-groebnerMatrix(3,66)/(groebnerMatrix(3,0)));
327 groebnerMatrix(32,67) = (groebnerMatrix(2,67)/(groebnerMatrix(2,0))-groebnerMatrix(3,67)/(groebnerMatrix(3,0)));
328 groebnerMatrix(32,68) = (groebnerMatrix(2,68)/(groebnerMatrix(2,0))-groebnerMatrix(3,68)/(groebnerMatrix(3,0)));
329 groebnerMatrix(32,69) = (groebnerMatrix(2,69)/(groebnerMatrix(2,0))-groebnerMatrix(3,69)/(groebnerMatrix(3,0)));
330 groebnerMatrix(32,70) = (groebnerMatrix(2,70)/(groebnerMatrix(2,0))-groebnerMatrix(3,70)/(groebnerMatrix(3,0)));
331 groebnerMatrix(32,71) = (groebnerMatrix(2,71)/(groebnerMatrix(2,0))-groebnerMatrix(3,71)/(groebnerMatrix(3,0)));
332 groebnerMatrix(32,73) = (groebnerMatrix(2,73)/(groebnerMatrix(2,0))-groebnerMatrix(3,73)/(groebnerMatrix(3,0)));
333 groebnerMatrix(32,74) = (groebnerMatrix(2,74)/(groebnerMatrix(2,0))-groebnerMatrix(3,74)/(groebnerMatrix(3,0)));
334 groebnerMatrix(32,76) = (groebnerMatrix(2,76)/(groebnerMatrix(2,0))-groebnerMatrix(3,76)/(groebnerMatrix(3,0)));
335 groebnerMatrix(32,77) = (groebnerMatrix(2,77)/(groebnerMatrix(2,0))-groebnerMatrix(3,77)/(groebnerMatrix(3,0)));
336 groebnerMatrix(32,78) = (groebnerMatrix(2,78)/(groebnerMatrix(2,0))-groebnerMatrix(3,78)/(groebnerMatrix(3,0)));
337 groebnerMatrix(32,79) = (groebnerMatrix(2,79)/(groebnerMatrix(2,0))-groebnerMatrix(3,79)/(groebnerMatrix(3,0)));
338 groebnerMatrix(32,80) = (groebnerMatrix(2,80)/(groebnerMatrix(2,0))-groebnerMatrix(3,80)/(groebnerMatrix(3,0)));
339 groebnerMatrix(32,81) = (groebnerMatrix(2,81)/(groebnerMatrix(2,0))-groebnerMatrix(3,81)/(groebnerMatrix(3,0)));
340 groebnerMatrix(32,82) = (groebnerMatrix(2,82)/(groebnerMatrix(2,0))-groebnerMatrix(3,82)/(groebnerMatrix(3,0)));
341 groebnerMatrix(32,83) = (groebnerMatrix(2,83)/(groebnerMatrix(2,0))-groebnerMatrix(3,83)/(groebnerMatrix(3,0)));
342 groebnerMatrix(32,84) = (groebnerMatrix(2,84)/(groebnerMatrix(2,0))-groebnerMatrix(3,84)/(groebnerMatrix(3,0)));
343 groebnerMatrix(32,85) = (groebnerMatrix(2,85)/(groebnerMatrix(2,0))-groebnerMatrix(3,85)/(groebnerMatrix(3,0)));
344 groebnerMatrix(32,86) = (groebnerMatrix(2,86)/(groebnerMatrix(2,0))-groebnerMatrix(3,86)/(groebnerMatrix(3,0)));
345 groebnerMatrix(32,87) = (groebnerMatrix(2,87)/(groebnerMatrix(2,0))-groebnerMatrix(3,87)/(groebnerMatrix(3,0)));
346 groebnerMatrix(32,89) = (groebnerMatrix(2,89)/(groebnerMatrix(2,0))-groebnerMatrix(3,89)/(groebnerMatrix(3,0)));
347 groebnerMatrix(32,91) = (groebnerMatrix(2,91)/(groebnerMatrix(2,0))-groebnerMatrix(3,91)/(groebnerMatrix(3,0)));
348 groebnerMatrix(32,92) = (groebnerMatrix(2,92)/(groebnerMatrix(2,0))-groebnerMatrix(3,92)/(groebnerMatrix(3,0)));
349 groebnerMatrix(32,94) = (groebnerMatrix(2,94)/(groebnerMatrix(2,0))-groebnerMatrix(3,94)/(groebnerMatrix(3,0)));
350 groebnerMatrix(32,97) = (groebnerMatrix(2,97)/(groebnerMatrix(2,0))-groebnerMatrix(3,97)/(groebnerMatrix(3,0)));
351 groebnerMatrix(32,98) = (groebnerMatrix(2,98)/(groebnerMatrix(2,0))-groebnerMatrix(3,98)/(groebnerMatrix(3,0)));
352 groebnerMatrix(32,99) = (groebnerMatrix(2,99)/(groebnerMatrix(2,0))-groebnerMatrix(3,99)/(groebnerMatrix(3,0)));
353 groebnerMatrix(32,100) = (groebnerMatrix(2,100)/(groebnerMatrix(2,0))-groebnerMatrix(3,100)/(groebnerMatrix(3,0)));
354 groebnerMatrix(32,101) = (groebnerMatrix(2,101)/(groebnerMatrix(2,0))-groebnerMatrix(3,101)/(groebnerMatrix(3,0)));
355 groebnerMatrix(32,103) = (groebnerMatrix(2,103)/(groebnerMatrix(2,0))-groebnerMatrix(3,103)/(groebnerMatrix(3,0)));
356 groebnerMatrix(32,104) = (groebnerMatrix(2,104)/(groebnerMatrix(2,0))-groebnerMatrix(3,104)/(groebnerMatrix(3,0)));
357 groebnerMatrix(32,105) = (groebnerMatrix(2,105)/(groebnerMatrix(2,0))-groebnerMatrix(3,105)/(groebnerMatrix(3,0)));
358 groebnerMatrix(32,106) = (groebnerMatrix(2,106)/(groebnerMatrix(2,0))-groebnerMatrix(3,106)/(groebnerMatrix(3,0)));
359 groebnerMatrix(32,107) = (groebnerMatrix(2,107)/(groebnerMatrix(2,0))-groebnerMatrix(3,107)/(groebnerMatrix(3,0)));
360 groebnerMatrix(32,108) = (groebnerMatrix(2,108)/(groebnerMatrix(2,0))-groebnerMatrix(3,108)/(groebnerMatrix(3,0)));
361 groebnerMatrix(32,109) = (groebnerMatrix(2,109)/(groebnerMatrix(2,0))-groebnerMatrix(3,109)/(groebnerMatrix(3,0)));
362 groebnerMatrix(32,110) = (groebnerMatrix(2,110)/(groebnerMatrix(2,0))-groebnerMatrix(3,110)/(groebnerMatrix(3,0)));
363 groebnerMatrix(32,111) = (groebnerMatrix(2,111)/(groebnerMatrix(2,0))-groebnerMatrix(3,111)/(groebnerMatrix(3,0)));
364 groebnerMatrix(32,112) = (groebnerMatrix(2,112)/(groebnerMatrix(2,0))-groebnerMatrix(3,112)/(groebnerMatrix(3,0)));
365 groebnerMatrix(32,113) = (groebnerMatrix(2,113)/(groebnerMatrix(2,0))-groebnerMatrix(3,113)/(groebnerMatrix(3,0)));
366 groebnerMatrix(32,115) = (groebnerMatrix(2,115)/(groebnerMatrix(2,0))-groebnerMatrix(3,115)/(groebnerMatrix(3,0)));
367 groebnerMatrix(32,116) = (groebnerMatrix(2,116)/(groebnerMatrix(2,0))-groebnerMatrix(3,116)/(groebnerMatrix(3,0)));
368 groebnerMatrix(32,118) = (groebnerMatrix(2,118)/(groebnerMatrix(2,0))-groebnerMatrix(3,118)/(groebnerMatrix(3,0)));
369 groebnerMatrix(32,119) = (groebnerMatrix(2,119)/(groebnerMatrix(2,0))-groebnerMatrix(3,119)/(groebnerMatrix(3,0)));
370 groebnerMatrix(32,120) = (groebnerMatrix(2,120)/(groebnerMatrix(2,0))-groebnerMatrix(3,120)/(groebnerMatrix(3,0)));
371 groebnerMatrix(32,121) = (groebnerMatrix(2,121)/(groebnerMatrix(2,0))-groebnerMatrix(3,121)/(groebnerMatrix(3,0)));
372 groebnerMatrix(32,122) = (groebnerMatrix(2,122)/(groebnerMatrix(2,0))-groebnerMatrix(3,122)/(groebnerMatrix(3,0)));
373 groebnerMatrix(32,123) = (groebnerMatrix(2,123)/(groebnerMatrix(2,0))-groebnerMatrix(3,123)/(groebnerMatrix(3,0)));
374 groebnerMatrix(32,125) = (groebnerMatrix(2,125)/(groebnerMatrix(2,0))-groebnerMatrix(3,125)/(groebnerMatrix(3,0)));
375 groebnerMatrix(32,126) = (groebnerMatrix(2,126)/(groebnerMatrix(2,0))-groebnerMatrix(3,126)/(groebnerMatrix(3,0)));
376 groebnerMatrix(32,127) = (groebnerMatrix(2,127)/(groebnerMatrix(2,0))-groebnerMatrix(3,127)/(groebnerMatrix(3,0)));
377 groebnerMatrix(32,128) = (groebnerMatrix(2,128)/(groebnerMatrix(2,0))-groebnerMatrix(3,128)/(groebnerMatrix(3,0)));
378 groebnerMatrix(32,129) = (groebnerMatrix(2,129)/(groebnerMatrix(2,0))-groebnerMatrix(3,129)/(groebnerMatrix(3,0)));
379 groebnerMatrix(32,130) = (groebnerMatrix(2,130)/(groebnerMatrix(2,0))-groebnerMatrix(3,130)/(groebnerMatrix(3,0)));
380 groebnerMatrix(32,133) = (groebnerMatrix(2,133)/(groebnerMatrix(2,0))-groebnerMatrix(3,133)/(groebnerMatrix(3,0)));
381 groebnerMatrix(32,134) = (groebnerMatrix(2,134)/(groebnerMatrix(2,0))-groebnerMatrix(3,134)/(groebnerMatrix(3,0)));
382 groebnerMatrix(32,136) = (groebnerMatrix(2,136)/(groebnerMatrix(2,0))-groebnerMatrix(3,136)/(groebnerMatrix(3,0)));
383 groebnerMatrix(32,137) = (groebnerMatrix(2,137)/(groebnerMatrix(2,0))-groebnerMatrix(3,137)/(groebnerMatrix(3,0)));
384 }
385
386 void
sPolynomial33(Eigen::Matrix<double,66,197> & groebnerMatrix)387 opengv::relative_pose::modules::fivept_kneip::sPolynomial33( Eigen::Matrix<double,66,197> & groebnerMatrix )
388 {
389 groebnerMatrix(33,1) = (groebnerMatrix(3,1)/(groebnerMatrix(3,0))-groebnerMatrix(4,1)/(groebnerMatrix(4,0)));
390 groebnerMatrix(33,2) = (groebnerMatrix(3,2)/(groebnerMatrix(3,0))-groebnerMatrix(4,2)/(groebnerMatrix(4,0)));
391 groebnerMatrix(33,3) = (groebnerMatrix(3,3)/(groebnerMatrix(3,0))-groebnerMatrix(4,3)/(groebnerMatrix(4,0)));
392 groebnerMatrix(33,4) = (groebnerMatrix(3,4)/(groebnerMatrix(3,0))-groebnerMatrix(4,4)/(groebnerMatrix(4,0)));
393 groebnerMatrix(33,5) = (groebnerMatrix(3,5)/(groebnerMatrix(3,0))-groebnerMatrix(4,5)/(groebnerMatrix(4,0)));
394 groebnerMatrix(33,6) = (groebnerMatrix(3,6)/(groebnerMatrix(3,0))-groebnerMatrix(4,6)/(groebnerMatrix(4,0)));
395 groebnerMatrix(33,8) = (groebnerMatrix(3,8)/(groebnerMatrix(3,0))-groebnerMatrix(4,8)/(groebnerMatrix(4,0)));
396 groebnerMatrix(33,10) = (groebnerMatrix(3,10)/(groebnerMatrix(3,0))-groebnerMatrix(4,10)/(groebnerMatrix(4,0)));
397 groebnerMatrix(33,11) = (groebnerMatrix(3,11)/(groebnerMatrix(3,0))-groebnerMatrix(4,11)/(groebnerMatrix(4,0)));
398 groebnerMatrix(33,12) = (groebnerMatrix(3,12)/(groebnerMatrix(3,0))-groebnerMatrix(4,12)/(groebnerMatrix(4,0)));
399 groebnerMatrix(33,13) = (groebnerMatrix(3,13)/(groebnerMatrix(3,0))-groebnerMatrix(4,13)/(groebnerMatrix(4,0)));
400 groebnerMatrix(33,14) = (groebnerMatrix(3,14)/(groebnerMatrix(3,0))-groebnerMatrix(4,14)/(groebnerMatrix(4,0)));
401 groebnerMatrix(33,15) = (groebnerMatrix(3,15)/(groebnerMatrix(3,0))-groebnerMatrix(4,15)/(groebnerMatrix(4,0)));
402 groebnerMatrix(33,16) = (groebnerMatrix(3,16)/(groebnerMatrix(3,0))-groebnerMatrix(4,16)/(groebnerMatrix(4,0)));
403 groebnerMatrix(33,18) = (groebnerMatrix(3,18)/(groebnerMatrix(3,0))-groebnerMatrix(4,18)/(groebnerMatrix(4,0)));
404 groebnerMatrix(33,19) = (groebnerMatrix(3,19)/(groebnerMatrix(3,0))-groebnerMatrix(4,19)/(groebnerMatrix(4,0)));
405 groebnerMatrix(33,20) = (groebnerMatrix(3,20)/(groebnerMatrix(3,0))-groebnerMatrix(4,20)/(groebnerMatrix(4,0)));
406 groebnerMatrix(33,21) = (groebnerMatrix(3,21)/(groebnerMatrix(3,0))-groebnerMatrix(4,21)/(groebnerMatrix(4,0)));
407 groebnerMatrix(33,22) = (groebnerMatrix(3,22)/(groebnerMatrix(3,0))-groebnerMatrix(4,22)/(groebnerMatrix(4,0)));
408 groebnerMatrix(33,23) = (groebnerMatrix(3,23)/(groebnerMatrix(3,0))-groebnerMatrix(4,23)/(groebnerMatrix(4,0)));
409 groebnerMatrix(33,25) = (groebnerMatrix(3,25)/(groebnerMatrix(3,0))-groebnerMatrix(4,25)/(groebnerMatrix(4,0)));
410 groebnerMatrix(33,26) = (groebnerMatrix(3,26)/(groebnerMatrix(3,0))-groebnerMatrix(4,26)/(groebnerMatrix(4,0)));
411 groebnerMatrix(33,27) = (groebnerMatrix(3,27)/(groebnerMatrix(3,0))-groebnerMatrix(4,27)/(groebnerMatrix(4,0)));
412 groebnerMatrix(33,28) = (groebnerMatrix(3,28)/(groebnerMatrix(3,0))-groebnerMatrix(4,28)/(groebnerMatrix(4,0)));
413 groebnerMatrix(33,29) = (groebnerMatrix(3,29)/(groebnerMatrix(3,0))-groebnerMatrix(4,29)/(groebnerMatrix(4,0)));
414 groebnerMatrix(33,30) = (groebnerMatrix(3,30)/(groebnerMatrix(3,0))-groebnerMatrix(4,30)/(groebnerMatrix(4,0)));
415 groebnerMatrix(33,33) = (groebnerMatrix(3,33)/(groebnerMatrix(3,0))-groebnerMatrix(4,33)/(groebnerMatrix(4,0)));
416 groebnerMatrix(33,34) = (groebnerMatrix(3,34)/(groebnerMatrix(3,0))-groebnerMatrix(4,34)/(groebnerMatrix(4,0)));
417 groebnerMatrix(33,39) = (groebnerMatrix(3,39)/(groebnerMatrix(3,0))-groebnerMatrix(4,39)/(groebnerMatrix(4,0)));
418 groebnerMatrix(33,40) = (groebnerMatrix(3,40)/(groebnerMatrix(3,0))-groebnerMatrix(4,40)/(groebnerMatrix(4,0)));
419 groebnerMatrix(33,41) = (groebnerMatrix(3,41)/(groebnerMatrix(3,0))-groebnerMatrix(4,41)/(groebnerMatrix(4,0)));
420 groebnerMatrix(33,42) = (groebnerMatrix(3,42)/(groebnerMatrix(3,0))-groebnerMatrix(4,42)/(groebnerMatrix(4,0)));
421 groebnerMatrix(33,43) = (groebnerMatrix(3,43)/(groebnerMatrix(3,0))-groebnerMatrix(4,43)/(groebnerMatrix(4,0)));
422 groebnerMatrix(33,44) = (groebnerMatrix(3,44)/(groebnerMatrix(3,0))-groebnerMatrix(4,44)/(groebnerMatrix(4,0)));
423 groebnerMatrix(33,45) = (groebnerMatrix(3,45)/(groebnerMatrix(3,0))-groebnerMatrix(4,45)/(groebnerMatrix(4,0)));
424 groebnerMatrix(33,46) = (groebnerMatrix(3,46)/(groebnerMatrix(3,0))-groebnerMatrix(4,46)/(groebnerMatrix(4,0)));
425 groebnerMatrix(33,47) = (groebnerMatrix(3,47)/(groebnerMatrix(3,0))-groebnerMatrix(4,47)/(groebnerMatrix(4,0)));
426 groebnerMatrix(33,48) = (groebnerMatrix(3,48)/(groebnerMatrix(3,0))-groebnerMatrix(4,48)/(groebnerMatrix(4,0)));
427 groebnerMatrix(33,49) = (groebnerMatrix(3,49)/(groebnerMatrix(3,0))-groebnerMatrix(4,49)/(groebnerMatrix(4,0)));
428 groebnerMatrix(33,50) = (groebnerMatrix(3,50)/(groebnerMatrix(3,0))-groebnerMatrix(4,50)/(groebnerMatrix(4,0)));
429 groebnerMatrix(33,51) = (groebnerMatrix(3,51)/(groebnerMatrix(3,0))-groebnerMatrix(4,51)/(groebnerMatrix(4,0)));
430 groebnerMatrix(33,52) = (groebnerMatrix(3,52)/(groebnerMatrix(3,0))-groebnerMatrix(4,52)/(groebnerMatrix(4,0)));
431 groebnerMatrix(33,53) = (groebnerMatrix(3,53)/(groebnerMatrix(3,0))-groebnerMatrix(4,53)/(groebnerMatrix(4,0)));
432 groebnerMatrix(33,54) = (groebnerMatrix(3,54)/(groebnerMatrix(3,0))-groebnerMatrix(4,54)/(groebnerMatrix(4,0)));
433 groebnerMatrix(33,55) = (groebnerMatrix(3,55)/(groebnerMatrix(3,0))-groebnerMatrix(4,55)/(groebnerMatrix(4,0)));
434 groebnerMatrix(33,56) = (groebnerMatrix(3,56)/(groebnerMatrix(3,0))-groebnerMatrix(4,56)/(groebnerMatrix(4,0)));
435 groebnerMatrix(33,57) = (groebnerMatrix(3,57)/(groebnerMatrix(3,0))-groebnerMatrix(4,57)/(groebnerMatrix(4,0)));
436 groebnerMatrix(33,58) = (groebnerMatrix(3,58)/(groebnerMatrix(3,0))-groebnerMatrix(4,58)/(groebnerMatrix(4,0)));
437 groebnerMatrix(33,59) = (groebnerMatrix(3,59)/(groebnerMatrix(3,0))-groebnerMatrix(4,59)/(groebnerMatrix(4,0)));
438 groebnerMatrix(33,60) = (groebnerMatrix(3,60)/(groebnerMatrix(3,0))-groebnerMatrix(4,60)/(groebnerMatrix(4,0)));
439 groebnerMatrix(33,61) = (groebnerMatrix(3,61)/(groebnerMatrix(3,0))-groebnerMatrix(4,61)/(groebnerMatrix(4,0)));
440 groebnerMatrix(33,62) = (groebnerMatrix(3,62)/(groebnerMatrix(3,0))-groebnerMatrix(4,62)/(groebnerMatrix(4,0)));
441 groebnerMatrix(33,64) = (groebnerMatrix(3,64)/(groebnerMatrix(3,0))-groebnerMatrix(4,64)/(groebnerMatrix(4,0)));
442 groebnerMatrix(33,65) = (groebnerMatrix(3,65)/(groebnerMatrix(3,0))-groebnerMatrix(4,65)/(groebnerMatrix(4,0)));
443 groebnerMatrix(33,66) = (groebnerMatrix(3,66)/(groebnerMatrix(3,0))-groebnerMatrix(4,66)/(groebnerMatrix(4,0)));
444 groebnerMatrix(33,67) = (groebnerMatrix(3,67)/(groebnerMatrix(3,0))-groebnerMatrix(4,67)/(groebnerMatrix(4,0)));
445 groebnerMatrix(33,68) = (groebnerMatrix(3,68)/(groebnerMatrix(3,0))-groebnerMatrix(4,68)/(groebnerMatrix(4,0)));
446 groebnerMatrix(33,69) = (groebnerMatrix(3,69)/(groebnerMatrix(3,0))-groebnerMatrix(4,69)/(groebnerMatrix(4,0)));
447 groebnerMatrix(33,70) = (groebnerMatrix(3,70)/(groebnerMatrix(3,0))-groebnerMatrix(4,70)/(groebnerMatrix(4,0)));
448 groebnerMatrix(33,71) = (groebnerMatrix(3,71)/(groebnerMatrix(3,0))-groebnerMatrix(4,71)/(groebnerMatrix(4,0)));
449 groebnerMatrix(33,73) = (groebnerMatrix(3,73)/(groebnerMatrix(3,0))-groebnerMatrix(4,73)/(groebnerMatrix(4,0)));
450 groebnerMatrix(33,74) = (groebnerMatrix(3,74)/(groebnerMatrix(3,0))-groebnerMatrix(4,74)/(groebnerMatrix(4,0)));
451 groebnerMatrix(33,76) = (groebnerMatrix(3,76)/(groebnerMatrix(3,0))-groebnerMatrix(4,76)/(groebnerMatrix(4,0)));
452 groebnerMatrix(33,77) = (groebnerMatrix(3,77)/(groebnerMatrix(3,0))-groebnerMatrix(4,77)/(groebnerMatrix(4,0)));
453 groebnerMatrix(33,78) = (groebnerMatrix(3,78)/(groebnerMatrix(3,0))-groebnerMatrix(4,78)/(groebnerMatrix(4,0)));
454 groebnerMatrix(33,79) = (groebnerMatrix(3,79)/(groebnerMatrix(3,0))-groebnerMatrix(4,79)/(groebnerMatrix(4,0)));
455 groebnerMatrix(33,80) = (groebnerMatrix(3,80)/(groebnerMatrix(3,0))-groebnerMatrix(4,80)/(groebnerMatrix(4,0)));
456 groebnerMatrix(33,81) = (groebnerMatrix(3,81)/(groebnerMatrix(3,0))-groebnerMatrix(4,81)/(groebnerMatrix(4,0)));
457 groebnerMatrix(33,82) = (groebnerMatrix(3,82)/(groebnerMatrix(3,0))-groebnerMatrix(4,82)/(groebnerMatrix(4,0)));
458 groebnerMatrix(33,83) = (groebnerMatrix(3,83)/(groebnerMatrix(3,0))-groebnerMatrix(4,83)/(groebnerMatrix(4,0)));
459 groebnerMatrix(33,84) = (groebnerMatrix(3,84)/(groebnerMatrix(3,0))-groebnerMatrix(4,84)/(groebnerMatrix(4,0)));
460 groebnerMatrix(33,85) = (groebnerMatrix(3,85)/(groebnerMatrix(3,0))-groebnerMatrix(4,85)/(groebnerMatrix(4,0)));
461 groebnerMatrix(33,86) = (groebnerMatrix(3,86)/(groebnerMatrix(3,0))-groebnerMatrix(4,86)/(groebnerMatrix(4,0)));
462 groebnerMatrix(33,87) = (groebnerMatrix(3,87)/(groebnerMatrix(3,0))-groebnerMatrix(4,87)/(groebnerMatrix(4,0)));
463 groebnerMatrix(33,89) = (groebnerMatrix(3,89)/(groebnerMatrix(3,0))-groebnerMatrix(4,89)/(groebnerMatrix(4,0)));
464 groebnerMatrix(33,91) = (groebnerMatrix(3,91)/(groebnerMatrix(3,0))-groebnerMatrix(4,91)/(groebnerMatrix(4,0)));
465 groebnerMatrix(33,92) = (groebnerMatrix(3,92)/(groebnerMatrix(3,0))-groebnerMatrix(4,92)/(groebnerMatrix(4,0)));
466 groebnerMatrix(33,94) = (groebnerMatrix(3,94)/(groebnerMatrix(3,0))-groebnerMatrix(4,94)/(groebnerMatrix(4,0)));
467 groebnerMatrix(33,97) = (groebnerMatrix(3,97)/(groebnerMatrix(3,0))-groebnerMatrix(4,97)/(groebnerMatrix(4,0)));
468 groebnerMatrix(33,98) = (groebnerMatrix(3,98)/(groebnerMatrix(3,0))-groebnerMatrix(4,98)/(groebnerMatrix(4,0)));
469 groebnerMatrix(33,99) = (groebnerMatrix(3,99)/(groebnerMatrix(3,0))-groebnerMatrix(4,99)/(groebnerMatrix(4,0)));
470 groebnerMatrix(33,100) = (groebnerMatrix(3,100)/(groebnerMatrix(3,0))-groebnerMatrix(4,100)/(groebnerMatrix(4,0)));
471 groebnerMatrix(33,101) = (groebnerMatrix(3,101)/(groebnerMatrix(3,0))-groebnerMatrix(4,101)/(groebnerMatrix(4,0)));
472 groebnerMatrix(33,103) = (groebnerMatrix(3,103)/(groebnerMatrix(3,0))-groebnerMatrix(4,103)/(groebnerMatrix(4,0)));
473 groebnerMatrix(33,104) = (groebnerMatrix(3,104)/(groebnerMatrix(3,0))-groebnerMatrix(4,104)/(groebnerMatrix(4,0)));
474 groebnerMatrix(33,105) = (groebnerMatrix(3,105)/(groebnerMatrix(3,0))-groebnerMatrix(4,105)/(groebnerMatrix(4,0)));
475 groebnerMatrix(33,106) = (groebnerMatrix(3,106)/(groebnerMatrix(3,0))-groebnerMatrix(4,106)/(groebnerMatrix(4,0)));
476 groebnerMatrix(33,107) = (groebnerMatrix(3,107)/(groebnerMatrix(3,0))-groebnerMatrix(4,107)/(groebnerMatrix(4,0)));
477 groebnerMatrix(33,108) = (groebnerMatrix(3,108)/(groebnerMatrix(3,0))-groebnerMatrix(4,108)/(groebnerMatrix(4,0)));
478 groebnerMatrix(33,109) = (groebnerMatrix(3,109)/(groebnerMatrix(3,0))-groebnerMatrix(4,109)/(groebnerMatrix(4,0)));
479 groebnerMatrix(33,110) = (groebnerMatrix(3,110)/(groebnerMatrix(3,0))-groebnerMatrix(4,110)/(groebnerMatrix(4,0)));
480 groebnerMatrix(33,111) = (groebnerMatrix(3,111)/(groebnerMatrix(3,0))-groebnerMatrix(4,111)/(groebnerMatrix(4,0)));
481 groebnerMatrix(33,112) = (groebnerMatrix(3,112)/(groebnerMatrix(3,0))-groebnerMatrix(4,112)/(groebnerMatrix(4,0)));
482 groebnerMatrix(33,113) = (groebnerMatrix(3,113)/(groebnerMatrix(3,0))-groebnerMatrix(4,113)/(groebnerMatrix(4,0)));
483 groebnerMatrix(33,115) = (groebnerMatrix(3,115)/(groebnerMatrix(3,0))-groebnerMatrix(4,115)/(groebnerMatrix(4,0)));
484 groebnerMatrix(33,116) = (groebnerMatrix(3,116)/(groebnerMatrix(3,0))-groebnerMatrix(4,116)/(groebnerMatrix(4,0)));
485 groebnerMatrix(33,118) = (groebnerMatrix(3,118)/(groebnerMatrix(3,0))-groebnerMatrix(4,118)/(groebnerMatrix(4,0)));
486 groebnerMatrix(33,119) = (groebnerMatrix(3,119)/(groebnerMatrix(3,0))-groebnerMatrix(4,119)/(groebnerMatrix(4,0)));
487 groebnerMatrix(33,120) = (groebnerMatrix(3,120)/(groebnerMatrix(3,0))-groebnerMatrix(4,120)/(groebnerMatrix(4,0)));
488 groebnerMatrix(33,121) = (groebnerMatrix(3,121)/(groebnerMatrix(3,0))-groebnerMatrix(4,121)/(groebnerMatrix(4,0)));
489 groebnerMatrix(33,122) = (groebnerMatrix(3,122)/(groebnerMatrix(3,0))-groebnerMatrix(4,122)/(groebnerMatrix(4,0)));
490 groebnerMatrix(33,123) = (groebnerMatrix(3,123)/(groebnerMatrix(3,0))-groebnerMatrix(4,123)/(groebnerMatrix(4,0)));
491 groebnerMatrix(33,125) = (groebnerMatrix(3,125)/(groebnerMatrix(3,0))-groebnerMatrix(4,125)/(groebnerMatrix(4,0)));
492 groebnerMatrix(33,126) = (groebnerMatrix(3,126)/(groebnerMatrix(3,0))-groebnerMatrix(4,126)/(groebnerMatrix(4,0)));
493 groebnerMatrix(33,127) = (groebnerMatrix(3,127)/(groebnerMatrix(3,0))-groebnerMatrix(4,127)/(groebnerMatrix(4,0)));
494 groebnerMatrix(33,128) = (groebnerMatrix(3,128)/(groebnerMatrix(3,0))-groebnerMatrix(4,128)/(groebnerMatrix(4,0)));
495 groebnerMatrix(33,129) = (groebnerMatrix(3,129)/(groebnerMatrix(3,0))-groebnerMatrix(4,129)/(groebnerMatrix(4,0)));
496 groebnerMatrix(33,130) = (groebnerMatrix(3,130)/(groebnerMatrix(3,0))-groebnerMatrix(4,130)/(groebnerMatrix(4,0)));
497 groebnerMatrix(33,133) = (groebnerMatrix(3,133)/(groebnerMatrix(3,0))-groebnerMatrix(4,133)/(groebnerMatrix(4,0)));
498 groebnerMatrix(33,134) = (groebnerMatrix(3,134)/(groebnerMatrix(3,0))-groebnerMatrix(4,134)/(groebnerMatrix(4,0)));
499 groebnerMatrix(33,136) = (groebnerMatrix(3,136)/(groebnerMatrix(3,0))-groebnerMatrix(4,136)/(groebnerMatrix(4,0)));
500 groebnerMatrix(33,137) = (groebnerMatrix(3,137)/(groebnerMatrix(3,0))-groebnerMatrix(4,137)/(groebnerMatrix(4,0)));
501 }
502
503 void
sPolynomial34(Eigen::Matrix<double,66,197> & groebnerMatrix)504 opengv::relative_pose::modules::fivept_kneip::sPolynomial34( Eigen::Matrix<double,66,197> & groebnerMatrix )
505 {
506 groebnerMatrix(34,1) = (groebnerMatrix(4,1)/(groebnerMatrix(4,0))-groebnerMatrix(5,1)/(groebnerMatrix(5,0)));
507 groebnerMatrix(34,2) = (groebnerMatrix(4,2)/(groebnerMatrix(4,0))-groebnerMatrix(5,2)/(groebnerMatrix(5,0)));
508 groebnerMatrix(34,3) = (groebnerMatrix(4,3)/(groebnerMatrix(4,0))-groebnerMatrix(5,3)/(groebnerMatrix(5,0)));
509 groebnerMatrix(34,4) = (groebnerMatrix(4,4)/(groebnerMatrix(4,0))-groebnerMatrix(5,4)/(groebnerMatrix(5,0)));
510 groebnerMatrix(34,5) = (groebnerMatrix(4,5)/(groebnerMatrix(4,0))-groebnerMatrix(5,5)/(groebnerMatrix(5,0)));
511 groebnerMatrix(34,6) = (groebnerMatrix(4,6)/(groebnerMatrix(4,0))-groebnerMatrix(5,6)/(groebnerMatrix(5,0)));
512 groebnerMatrix(34,8) = (groebnerMatrix(4,8)/(groebnerMatrix(4,0))-groebnerMatrix(5,8)/(groebnerMatrix(5,0)));
513 groebnerMatrix(34,10) = (groebnerMatrix(4,10)/(groebnerMatrix(4,0))-groebnerMatrix(5,10)/(groebnerMatrix(5,0)));
514 groebnerMatrix(34,11) = (groebnerMatrix(4,11)/(groebnerMatrix(4,0))-groebnerMatrix(5,11)/(groebnerMatrix(5,0)));
515 groebnerMatrix(34,12) = (groebnerMatrix(4,12)/(groebnerMatrix(4,0))-groebnerMatrix(5,12)/(groebnerMatrix(5,0)));
516 groebnerMatrix(34,13) = (groebnerMatrix(4,13)/(groebnerMatrix(4,0))-groebnerMatrix(5,13)/(groebnerMatrix(5,0)));
517 groebnerMatrix(34,14) = (groebnerMatrix(4,14)/(groebnerMatrix(4,0))-groebnerMatrix(5,14)/(groebnerMatrix(5,0)));
518 groebnerMatrix(34,15) = (groebnerMatrix(4,15)/(groebnerMatrix(4,0))-groebnerMatrix(5,15)/(groebnerMatrix(5,0)));
519 groebnerMatrix(34,16) = (groebnerMatrix(4,16)/(groebnerMatrix(4,0))-groebnerMatrix(5,16)/(groebnerMatrix(5,0)));
520 groebnerMatrix(34,18) = (groebnerMatrix(4,18)/(groebnerMatrix(4,0))-groebnerMatrix(5,18)/(groebnerMatrix(5,0)));
521 groebnerMatrix(34,19) = (groebnerMatrix(4,19)/(groebnerMatrix(4,0))-groebnerMatrix(5,19)/(groebnerMatrix(5,0)));
522 groebnerMatrix(34,20) = (groebnerMatrix(4,20)/(groebnerMatrix(4,0))-groebnerMatrix(5,20)/(groebnerMatrix(5,0)));
523 groebnerMatrix(34,21) = (groebnerMatrix(4,21)/(groebnerMatrix(4,0))-groebnerMatrix(5,21)/(groebnerMatrix(5,0)));
524 groebnerMatrix(34,22) = (groebnerMatrix(4,22)/(groebnerMatrix(4,0))-groebnerMatrix(5,22)/(groebnerMatrix(5,0)));
525 groebnerMatrix(34,23) = (groebnerMatrix(4,23)/(groebnerMatrix(4,0))-groebnerMatrix(5,23)/(groebnerMatrix(5,0)));
526 groebnerMatrix(34,25) = (groebnerMatrix(4,25)/(groebnerMatrix(4,0))-groebnerMatrix(5,25)/(groebnerMatrix(5,0)));
527 groebnerMatrix(34,26) = (groebnerMatrix(4,26)/(groebnerMatrix(4,0))-groebnerMatrix(5,26)/(groebnerMatrix(5,0)));
528 groebnerMatrix(34,27) = (groebnerMatrix(4,27)/(groebnerMatrix(4,0))-groebnerMatrix(5,27)/(groebnerMatrix(5,0)));
529 groebnerMatrix(34,28) = (groebnerMatrix(4,28)/(groebnerMatrix(4,0))-groebnerMatrix(5,28)/(groebnerMatrix(5,0)));
530 groebnerMatrix(34,29) = (groebnerMatrix(4,29)/(groebnerMatrix(4,0))-groebnerMatrix(5,29)/(groebnerMatrix(5,0)));
531 groebnerMatrix(34,30) = (groebnerMatrix(4,30)/(groebnerMatrix(4,0))-groebnerMatrix(5,30)/(groebnerMatrix(5,0)));
532 groebnerMatrix(34,33) = (groebnerMatrix(4,33)/(groebnerMatrix(4,0))-groebnerMatrix(5,33)/(groebnerMatrix(5,0)));
533 groebnerMatrix(34,34) = (groebnerMatrix(4,34)/(groebnerMatrix(4,0))-groebnerMatrix(5,34)/(groebnerMatrix(5,0)));
534 groebnerMatrix(34,39) = (groebnerMatrix(4,39)/(groebnerMatrix(4,0))-groebnerMatrix(5,39)/(groebnerMatrix(5,0)));
535 groebnerMatrix(34,40) = (groebnerMatrix(4,40)/(groebnerMatrix(4,0))-groebnerMatrix(5,40)/(groebnerMatrix(5,0)));
536 groebnerMatrix(34,41) = (groebnerMatrix(4,41)/(groebnerMatrix(4,0))-groebnerMatrix(5,41)/(groebnerMatrix(5,0)));
537 groebnerMatrix(34,42) = (groebnerMatrix(4,42)/(groebnerMatrix(4,0))-groebnerMatrix(5,42)/(groebnerMatrix(5,0)));
538 groebnerMatrix(34,43) = (groebnerMatrix(4,43)/(groebnerMatrix(4,0))-groebnerMatrix(5,43)/(groebnerMatrix(5,0)));
539 groebnerMatrix(34,44) = (groebnerMatrix(4,44)/(groebnerMatrix(4,0))-groebnerMatrix(5,44)/(groebnerMatrix(5,0)));
540 groebnerMatrix(34,45) = (groebnerMatrix(4,45)/(groebnerMatrix(4,0))-groebnerMatrix(5,45)/(groebnerMatrix(5,0)));
541 groebnerMatrix(34,46) = (groebnerMatrix(4,46)/(groebnerMatrix(4,0))-groebnerMatrix(5,46)/(groebnerMatrix(5,0)));
542 groebnerMatrix(34,47) = (groebnerMatrix(4,47)/(groebnerMatrix(4,0))-groebnerMatrix(5,47)/(groebnerMatrix(5,0)));
543 groebnerMatrix(34,48) = (groebnerMatrix(4,48)/(groebnerMatrix(4,0))-groebnerMatrix(5,48)/(groebnerMatrix(5,0)));
544 groebnerMatrix(34,49) = (groebnerMatrix(4,49)/(groebnerMatrix(4,0))-groebnerMatrix(5,49)/(groebnerMatrix(5,0)));
545 groebnerMatrix(34,50) = (groebnerMatrix(4,50)/(groebnerMatrix(4,0))-groebnerMatrix(5,50)/(groebnerMatrix(5,0)));
546 groebnerMatrix(34,51) = (groebnerMatrix(4,51)/(groebnerMatrix(4,0))-groebnerMatrix(5,51)/(groebnerMatrix(5,0)));
547 groebnerMatrix(34,52) = (groebnerMatrix(4,52)/(groebnerMatrix(4,0))-groebnerMatrix(5,52)/(groebnerMatrix(5,0)));
548 groebnerMatrix(34,53) = (groebnerMatrix(4,53)/(groebnerMatrix(4,0))-groebnerMatrix(5,53)/(groebnerMatrix(5,0)));
549 groebnerMatrix(34,54) = (groebnerMatrix(4,54)/(groebnerMatrix(4,0))-groebnerMatrix(5,54)/(groebnerMatrix(5,0)));
550 groebnerMatrix(34,55) = (groebnerMatrix(4,55)/(groebnerMatrix(4,0))-groebnerMatrix(5,55)/(groebnerMatrix(5,0)));
551 groebnerMatrix(34,56) = (groebnerMatrix(4,56)/(groebnerMatrix(4,0))-groebnerMatrix(5,56)/(groebnerMatrix(5,0)));
552 groebnerMatrix(34,57) = (groebnerMatrix(4,57)/(groebnerMatrix(4,0))-groebnerMatrix(5,57)/(groebnerMatrix(5,0)));
553 groebnerMatrix(34,58) = (groebnerMatrix(4,58)/(groebnerMatrix(4,0))-groebnerMatrix(5,58)/(groebnerMatrix(5,0)));
554 groebnerMatrix(34,59) = (groebnerMatrix(4,59)/(groebnerMatrix(4,0))-groebnerMatrix(5,59)/(groebnerMatrix(5,0)));
555 groebnerMatrix(34,60) = (groebnerMatrix(4,60)/(groebnerMatrix(4,0))-groebnerMatrix(5,60)/(groebnerMatrix(5,0)));
556 groebnerMatrix(34,61) = (groebnerMatrix(4,61)/(groebnerMatrix(4,0))-groebnerMatrix(5,61)/(groebnerMatrix(5,0)));
557 groebnerMatrix(34,62) = (groebnerMatrix(4,62)/(groebnerMatrix(4,0))-groebnerMatrix(5,62)/(groebnerMatrix(5,0)));
558 groebnerMatrix(34,64) = (groebnerMatrix(4,64)/(groebnerMatrix(4,0))-groebnerMatrix(5,64)/(groebnerMatrix(5,0)));
559 groebnerMatrix(34,65) = (groebnerMatrix(4,65)/(groebnerMatrix(4,0))-groebnerMatrix(5,65)/(groebnerMatrix(5,0)));
560 groebnerMatrix(34,66) = (groebnerMatrix(4,66)/(groebnerMatrix(4,0))-groebnerMatrix(5,66)/(groebnerMatrix(5,0)));
561 groebnerMatrix(34,67) = (groebnerMatrix(4,67)/(groebnerMatrix(4,0))-groebnerMatrix(5,67)/(groebnerMatrix(5,0)));
562 groebnerMatrix(34,68) = (groebnerMatrix(4,68)/(groebnerMatrix(4,0))-groebnerMatrix(5,68)/(groebnerMatrix(5,0)));
563 groebnerMatrix(34,69) = (groebnerMatrix(4,69)/(groebnerMatrix(4,0))-groebnerMatrix(5,69)/(groebnerMatrix(5,0)));
564 groebnerMatrix(34,70) = (groebnerMatrix(4,70)/(groebnerMatrix(4,0))-groebnerMatrix(5,70)/(groebnerMatrix(5,0)));
565 groebnerMatrix(34,71) = (groebnerMatrix(4,71)/(groebnerMatrix(4,0))-groebnerMatrix(5,71)/(groebnerMatrix(5,0)));
566 groebnerMatrix(34,73) = (groebnerMatrix(4,73)/(groebnerMatrix(4,0))-groebnerMatrix(5,73)/(groebnerMatrix(5,0)));
567 groebnerMatrix(34,74) = (groebnerMatrix(4,74)/(groebnerMatrix(4,0))-groebnerMatrix(5,74)/(groebnerMatrix(5,0)));
568 groebnerMatrix(34,76) = (groebnerMatrix(4,76)/(groebnerMatrix(4,0))-groebnerMatrix(5,76)/(groebnerMatrix(5,0)));
569 groebnerMatrix(34,77) = (groebnerMatrix(4,77)/(groebnerMatrix(4,0))-groebnerMatrix(5,77)/(groebnerMatrix(5,0)));
570 groebnerMatrix(34,78) = (groebnerMatrix(4,78)/(groebnerMatrix(4,0))-groebnerMatrix(5,78)/(groebnerMatrix(5,0)));
571 groebnerMatrix(34,79) = (groebnerMatrix(4,79)/(groebnerMatrix(4,0))-groebnerMatrix(5,79)/(groebnerMatrix(5,0)));
572 groebnerMatrix(34,80) = (groebnerMatrix(4,80)/(groebnerMatrix(4,0))-groebnerMatrix(5,80)/(groebnerMatrix(5,0)));
573 groebnerMatrix(34,81) = (groebnerMatrix(4,81)/(groebnerMatrix(4,0))-groebnerMatrix(5,81)/(groebnerMatrix(5,0)));
574 groebnerMatrix(34,82) = (groebnerMatrix(4,82)/(groebnerMatrix(4,0))-groebnerMatrix(5,82)/(groebnerMatrix(5,0)));
575 groebnerMatrix(34,83) = (groebnerMatrix(4,83)/(groebnerMatrix(4,0))-groebnerMatrix(5,83)/(groebnerMatrix(5,0)));
576 groebnerMatrix(34,84) = (groebnerMatrix(4,84)/(groebnerMatrix(4,0))-groebnerMatrix(5,84)/(groebnerMatrix(5,0)));
577 groebnerMatrix(34,85) = (groebnerMatrix(4,85)/(groebnerMatrix(4,0))-groebnerMatrix(5,85)/(groebnerMatrix(5,0)));
578 groebnerMatrix(34,86) = (groebnerMatrix(4,86)/(groebnerMatrix(4,0))-groebnerMatrix(5,86)/(groebnerMatrix(5,0)));
579 groebnerMatrix(34,87) = (groebnerMatrix(4,87)/(groebnerMatrix(4,0))-groebnerMatrix(5,87)/(groebnerMatrix(5,0)));
580 groebnerMatrix(34,89) = (groebnerMatrix(4,89)/(groebnerMatrix(4,0))-groebnerMatrix(5,89)/(groebnerMatrix(5,0)));
581 groebnerMatrix(34,91) = (groebnerMatrix(4,91)/(groebnerMatrix(4,0))-groebnerMatrix(5,91)/(groebnerMatrix(5,0)));
582 groebnerMatrix(34,92) = (groebnerMatrix(4,92)/(groebnerMatrix(4,0))-groebnerMatrix(5,92)/(groebnerMatrix(5,0)));
583 groebnerMatrix(34,94) = (groebnerMatrix(4,94)/(groebnerMatrix(4,0))-groebnerMatrix(5,94)/(groebnerMatrix(5,0)));
584 groebnerMatrix(34,97) = (groebnerMatrix(4,97)/(groebnerMatrix(4,0))-groebnerMatrix(5,97)/(groebnerMatrix(5,0)));
585 groebnerMatrix(34,98) = (groebnerMatrix(4,98)/(groebnerMatrix(4,0))-groebnerMatrix(5,98)/(groebnerMatrix(5,0)));
586 groebnerMatrix(34,99) = (groebnerMatrix(4,99)/(groebnerMatrix(4,0))-groebnerMatrix(5,99)/(groebnerMatrix(5,0)));
587 groebnerMatrix(34,100) = (groebnerMatrix(4,100)/(groebnerMatrix(4,0))-groebnerMatrix(5,100)/(groebnerMatrix(5,0)));
588 groebnerMatrix(34,101) = (groebnerMatrix(4,101)/(groebnerMatrix(4,0))-groebnerMatrix(5,101)/(groebnerMatrix(5,0)));
589 groebnerMatrix(34,103) = (groebnerMatrix(4,103)/(groebnerMatrix(4,0))-groebnerMatrix(5,103)/(groebnerMatrix(5,0)));
590 groebnerMatrix(34,104) = (groebnerMatrix(4,104)/(groebnerMatrix(4,0))-groebnerMatrix(5,104)/(groebnerMatrix(5,0)));
591 groebnerMatrix(34,105) = (groebnerMatrix(4,105)/(groebnerMatrix(4,0))-groebnerMatrix(5,105)/(groebnerMatrix(5,0)));
592 groebnerMatrix(34,106) = (groebnerMatrix(4,106)/(groebnerMatrix(4,0))-groebnerMatrix(5,106)/(groebnerMatrix(5,0)));
593 groebnerMatrix(34,107) = (groebnerMatrix(4,107)/(groebnerMatrix(4,0))-groebnerMatrix(5,107)/(groebnerMatrix(5,0)));
594 groebnerMatrix(34,108) = (groebnerMatrix(4,108)/(groebnerMatrix(4,0))-groebnerMatrix(5,108)/(groebnerMatrix(5,0)));
595 groebnerMatrix(34,109) = (groebnerMatrix(4,109)/(groebnerMatrix(4,0))-groebnerMatrix(5,109)/(groebnerMatrix(5,0)));
596 groebnerMatrix(34,110) = (groebnerMatrix(4,110)/(groebnerMatrix(4,0))-groebnerMatrix(5,110)/(groebnerMatrix(5,0)));
597 groebnerMatrix(34,111) = (groebnerMatrix(4,111)/(groebnerMatrix(4,0))-groebnerMatrix(5,111)/(groebnerMatrix(5,0)));
598 groebnerMatrix(34,112) = (groebnerMatrix(4,112)/(groebnerMatrix(4,0))-groebnerMatrix(5,112)/(groebnerMatrix(5,0)));
599 groebnerMatrix(34,113) = (groebnerMatrix(4,113)/(groebnerMatrix(4,0))-groebnerMatrix(5,113)/(groebnerMatrix(5,0)));
600 groebnerMatrix(34,115) = (groebnerMatrix(4,115)/(groebnerMatrix(4,0))-groebnerMatrix(5,115)/(groebnerMatrix(5,0)));
601 groebnerMatrix(34,116) = (groebnerMatrix(4,116)/(groebnerMatrix(4,0))-groebnerMatrix(5,116)/(groebnerMatrix(5,0)));
602 groebnerMatrix(34,118) = (groebnerMatrix(4,118)/(groebnerMatrix(4,0))-groebnerMatrix(5,118)/(groebnerMatrix(5,0)));
603 groebnerMatrix(34,119) = (groebnerMatrix(4,119)/(groebnerMatrix(4,0))-groebnerMatrix(5,119)/(groebnerMatrix(5,0)));
604 groebnerMatrix(34,120) = (groebnerMatrix(4,120)/(groebnerMatrix(4,0))-groebnerMatrix(5,120)/(groebnerMatrix(5,0)));
605 groebnerMatrix(34,121) = (groebnerMatrix(4,121)/(groebnerMatrix(4,0))-groebnerMatrix(5,121)/(groebnerMatrix(5,0)));
606 groebnerMatrix(34,122) = (groebnerMatrix(4,122)/(groebnerMatrix(4,0))-groebnerMatrix(5,122)/(groebnerMatrix(5,0)));
607 groebnerMatrix(34,123) = (groebnerMatrix(4,123)/(groebnerMatrix(4,0))-groebnerMatrix(5,123)/(groebnerMatrix(5,0)));
608 groebnerMatrix(34,125) = (groebnerMatrix(4,125)/(groebnerMatrix(4,0))-groebnerMatrix(5,125)/(groebnerMatrix(5,0)));
609 groebnerMatrix(34,126) = (groebnerMatrix(4,126)/(groebnerMatrix(4,0))-groebnerMatrix(5,126)/(groebnerMatrix(5,0)));
610 groebnerMatrix(34,127) = (groebnerMatrix(4,127)/(groebnerMatrix(4,0))-groebnerMatrix(5,127)/(groebnerMatrix(5,0)));
611 groebnerMatrix(34,128) = (groebnerMatrix(4,128)/(groebnerMatrix(4,0))-groebnerMatrix(5,128)/(groebnerMatrix(5,0)));
612 groebnerMatrix(34,129) = (groebnerMatrix(4,129)/(groebnerMatrix(4,0))-groebnerMatrix(5,129)/(groebnerMatrix(5,0)));
613 groebnerMatrix(34,130) = (groebnerMatrix(4,130)/(groebnerMatrix(4,0))-groebnerMatrix(5,130)/(groebnerMatrix(5,0)));
614 groebnerMatrix(34,133) = (groebnerMatrix(4,133)/(groebnerMatrix(4,0))-groebnerMatrix(5,133)/(groebnerMatrix(5,0)));
615 groebnerMatrix(34,134) = (groebnerMatrix(4,134)/(groebnerMatrix(4,0))-groebnerMatrix(5,134)/(groebnerMatrix(5,0)));
616 groebnerMatrix(34,136) = (groebnerMatrix(4,136)/(groebnerMatrix(4,0))-groebnerMatrix(5,136)/(groebnerMatrix(5,0)));
617 groebnerMatrix(34,137) = (groebnerMatrix(4,137)/(groebnerMatrix(4,0))-groebnerMatrix(5,137)/(groebnerMatrix(5,0)));
618 }
619
620 void
sPolynomial35(Eigen::Matrix<double,66,197> & groebnerMatrix)621 opengv::relative_pose::modules::fivept_kneip::sPolynomial35( Eigen::Matrix<double,66,197> & groebnerMatrix )
622 {
623 groebnerMatrix(35,1) = (groebnerMatrix(5,1)/(groebnerMatrix(5,0))-groebnerMatrix(6,1)/(groebnerMatrix(6,0)));
624 groebnerMatrix(35,2) = (groebnerMatrix(5,2)/(groebnerMatrix(5,0))-groebnerMatrix(6,2)/(groebnerMatrix(6,0)));
625 groebnerMatrix(35,3) = (groebnerMatrix(5,3)/(groebnerMatrix(5,0))-groebnerMatrix(6,3)/(groebnerMatrix(6,0)));
626 groebnerMatrix(35,4) = (groebnerMatrix(5,4)/(groebnerMatrix(5,0))-groebnerMatrix(6,4)/(groebnerMatrix(6,0)));
627 groebnerMatrix(35,5) = (groebnerMatrix(5,5)/(groebnerMatrix(5,0))-groebnerMatrix(6,5)/(groebnerMatrix(6,0)));
628 groebnerMatrix(35,6) = (groebnerMatrix(5,6)/(groebnerMatrix(5,0))-groebnerMatrix(6,6)/(groebnerMatrix(6,0)));
629 groebnerMatrix(35,8) = (groebnerMatrix(5,8)/(groebnerMatrix(5,0))-groebnerMatrix(6,8)/(groebnerMatrix(6,0)));
630 groebnerMatrix(35,10) = (groebnerMatrix(5,10)/(groebnerMatrix(5,0))-groebnerMatrix(6,10)/(groebnerMatrix(6,0)));
631 groebnerMatrix(35,11) = (groebnerMatrix(5,11)/(groebnerMatrix(5,0))-groebnerMatrix(6,11)/(groebnerMatrix(6,0)));
632 groebnerMatrix(35,12) = (groebnerMatrix(5,12)/(groebnerMatrix(5,0))-groebnerMatrix(6,12)/(groebnerMatrix(6,0)));
633 groebnerMatrix(35,13) = (groebnerMatrix(5,13)/(groebnerMatrix(5,0))-groebnerMatrix(6,13)/(groebnerMatrix(6,0)));
634 groebnerMatrix(35,14) = (groebnerMatrix(5,14)/(groebnerMatrix(5,0))-groebnerMatrix(6,14)/(groebnerMatrix(6,0)));
635 groebnerMatrix(35,15) = (groebnerMatrix(5,15)/(groebnerMatrix(5,0))-groebnerMatrix(6,15)/(groebnerMatrix(6,0)));
636 groebnerMatrix(35,16) = (groebnerMatrix(5,16)/(groebnerMatrix(5,0))-groebnerMatrix(6,16)/(groebnerMatrix(6,0)));
637 groebnerMatrix(35,18) = (groebnerMatrix(5,18)/(groebnerMatrix(5,0))-groebnerMatrix(6,18)/(groebnerMatrix(6,0)));
638 groebnerMatrix(35,19) = (groebnerMatrix(5,19)/(groebnerMatrix(5,0))-groebnerMatrix(6,19)/(groebnerMatrix(6,0)));
639 groebnerMatrix(35,20) = (groebnerMatrix(5,20)/(groebnerMatrix(5,0))-groebnerMatrix(6,20)/(groebnerMatrix(6,0)));
640 groebnerMatrix(35,21) = (groebnerMatrix(5,21)/(groebnerMatrix(5,0))-groebnerMatrix(6,21)/(groebnerMatrix(6,0)));
641 groebnerMatrix(35,22) = (groebnerMatrix(5,22)/(groebnerMatrix(5,0))-groebnerMatrix(6,22)/(groebnerMatrix(6,0)));
642 groebnerMatrix(35,23) = (groebnerMatrix(5,23)/(groebnerMatrix(5,0))-groebnerMatrix(6,23)/(groebnerMatrix(6,0)));
643 groebnerMatrix(35,25) = (groebnerMatrix(5,25)/(groebnerMatrix(5,0))-groebnerMatrix(6,25)/(groebnerMatrix(6,0)));
644 groebnerMatrix(35,26) = (groebnerMatrix(5,26)/(groebnerMatrix(5,0))-groebnerMatrix(6,26)/(groebnerMatrix(6,0)));
645 groebnerMatrix(35,27) = (groebnerMatrix(5,27)/(groebnerMatrix(5,0))-groebnerMatrix(6,27)/(groebnerMatrix(6,0)));
646 groebnerMatrix(35,28) = (groebnerMatrix(5,28)/(groebnerMatrix(5,0))-groebnerMatrix(6,28)/(groebnerMatrix(6,0)));
647 groebnerMatrix(35,29) = (groebnerMatrix(5,29)/(groebnerMatrix(5,0))-groebnerMatrix(6,29)/(groebnerMatrix(6,0)));
648 groebnerMatrix(35,30) = (groebnerMatrix(5,30)/(groebnerMatrix(5,0))-groebnerMatrix(6,30)/(groebnerMatrix(6,0)));
649 groebnerMatrix(35,33) = (groebnerMatrix(5,33)/(groebnerMatrix(5,0))-groebnerMatrix(6,33)/(groebnerMatrix(6,0)));
650 groebnerMatrix(35,34) = (groebnerMatrix(5,34)/(groebnerMatrix(5,0))-groebnerMatrix(6,34)/(groebnerMatrix(6,0)));
651 groebnerMatrix(35,39) = (groebnerMatrix(5,39)/(groebnerMatrix(5,0))-groebnerMatrix(6,39)/(groebnerMatrix(6,0)));
652 groebnerMatrix(35,40) = (groebnerMatrix(5,40)/(groebnerMatrix(5,0))-groebnerMatrix(6,40)/(groebnerMatrix(6,0)));
653 groebnerMatrix(35,41) = (groebnerMatrix(5,41)/(groebnerMatrix(5,0))-groebnerMatrix(6,41)/(groebnerMatrix(6,0)));
654 groebnerMatrix(35,42) = (groebnerMatrix(5,42)/(groebnerMatrix(5,0))-groebnerMatrix(6,42)/(groebnerMatrix(6,0)));
655 groebnerMatrix(35,43) = (groebnerMatrix(5,43)/(groebnerMatrix(5,0))-groebnerMatrix(6,43)/(groebnerMatrix(6,0)));
656 groebnerMatrix(35,44) = (groebnerMatrix(5,44)/(groebnerMatrix(5,0))-groebnerMatrix(6,44)/(groebnerMatrix(6,0)));
657 groebnerMatrix(35,45) = (groebnerMatrix(5,45)/(groebnerMatrix(5,0))-groebnerMatrix(6,45)/(groebnerMatrix(6,0)));
658 groebnerMatrix(35,46) = (groebnerMatrix(5,46)/(groebnerMatrix(5,0))-groebnerMatrix(6,46)/(groebnerMatrix(6,0)));
659 groebnerMatrix(35,47) = (groebnerMatrix(5,47)/(groebnerMatrix(5,0))-groebnerMatrix(6,47)/(groebnerMatrix(6,0)));
660 groebnerMatrix(35,48) = (groebnerMatrix(5,48)/(groebnerMatrix(5,0))-groebnerMatrix(6,48)/(groebnerMatrix(6,0)));
661 groebnerMatrix(35,49) = (groebnerMatrix(5,49)/(groebnerMatrix(5,0))-groebnerMatrix(6,49)/(groebnerMatrix(6,0)));
662 groebnerMatrix(35,50) = (groebnerMatrix(5,50)/(groebnerMatrix(5,0))-groebnerMatrix(6,50)/(groebnerMatrix(6,0)));
663 groebnerMatrix(35,51) = (groebnerMatrix(5,51)/(groebnerMatrix(5,0))-groebnerMatrix(6,51)/(groebnerMatrix(6,0)));
664 groebnerMatrix(35,52) = (groebnerMatrix(5,52)/(groebnerMatrix(5,0))-groebnerMatrix(6,52)/(groebnerMatrix(6,0)));
665 groebnerMatrix(35,53) = (groebnerMatrix(5,53)/(groebnerMatrix(5,0))-groebnerMatrix(6,53)/(groebnerMatrix(6,0)));
666 groebnerMatrix(35,54) = (groebnerMatrix(5,54)/(groebnerMatrix(5,0))-groebnerMatrix(6,54)/(groebnerMatrix(6,0)));
667 groebnerMatrix(35,55) = (groebnerMatrix(5,55)/(groebnerMatrix(5,0))-groebnerMatrix(6,55)/(groebnerMatrix(6,0)));
668 groebnerMatrix(35,56) = (groebnerMatrix(5,56)/(groebnerMatrix(5,0))-groebnerMatrix(6,56)/(groebnerMatrix(6,0)));
669 groebnerMatrix(35,57) = (groebnerMatrix(5,57)/(groebnerMatrix(5,0))-groebnerMatrix(6,57)/(groebnerMatrix(6,0)));
670 groebnerMatrix(35,58) = (groebnerMatrix(5,58)/(groebnerMatrix(5,0))-groebnerMatrix(6,58)/(groebnerMatrix(6,0)));
671 groebnerMatrix(35,59) = (groebnerMatrix(5,59)/(groebnerMatrix(5,0))-groebnerMatrix(6,59)/(groebnerMatrix(6,0)));
672 groebnerMatrix(35,60) = (groebnerMatrix(5,60)/(groebnerMatrix(5,0))-groebnerMatrix(6,60)/(groebnerMatrix(6,0)));
673 groebnerMatrix(35,61) = (groebnerMatrix(5,61)/(groebnerMatrix(5,0))-groebnerMatrix(6,61)/(groebnerMatrix(6,0)));
674 groebnerMatrix(35,62) = (groebnerMatrix(5,62)/(groebnerMatrix(5,0))-groebnerMatrix(6,62)/(groebnerMatrix(6,0)));
675 groebnerMatrix(35,64) = (groebnerMatrix(5,64)/(groebnerMatrix(5,0))-groebnerMatrix(6,64)/(groebnerMatrix(6,0)));
676 groebnerMatrix(35,65) = (groebnerMatrix(5,65)/(groebnerMatrix(5,0))-groebnerMatrix(6,65)/(groebnerMatrix(6,0)));
677 groebnerMatrix(35,66) = (groebnerMatrix(5,66)/(groebnerMatrix(5,0))-groebnerMatrix(6,66)/(groebnerMatrix(6,0)));
678 groebnerMatrix(35,67) = (groebnerMatrix(5,67)/(groebnerMatrix(5,0))-groebnerMatrix(6,67)/(groebnerMatrix(6,0)));
679 groebnerMatrix(35,68) = (groebnerMatrix(5,68)/(groebnerMatrix(5,0))-groebnerMatrix(6,68)/(groebnerMatrix(6,0)));
680 groebnerMatrix(35,69) = (groebnerMatrix(5,69)/(groebnerMatrix(5,0))-groebnerMatrix(6,69)/(groebnerMatrix(6,0)));
681 groebnerMatrix(35,70) = (groebnerMatrix(5,70)/(groebnerMatrix(5,0))-groebnerMatrix(6,70)/(groebnerMatrix(6,0)));
682 groebnerMatrix(35,71) = (groebnerMatrix(5,71)/(groebnerMatrix(5,0))-groebnerMatrix(6,71)/(groebnerMatrix(6,0)));
683 groebnerMatrix(35,73) = (groebnerMatrix(5,73)/(groebnerMatrix(5,0))-groebnerMatrix(6,73)/(groebnerMatrix(6,0)));
684 groebnerMatrix(35,74) = (groebnerMatrix(5,74)/(groebnerMatrix(5,0))-groebnerMatrix(6,74)/(groebnerMatrix(6,0)));
685 groebnerMatrix(35,76) = (groebnerMatrix(5,76)/(groebnerMatrix(5,0))-groebnerMatrix(6,76)/(groebnerMatrix(6,0)));
686 groebnerMatrix(35,77) = (groebnerMatrix(5,77)/(groebnerMatrix(5,0))-groebnerMatrix(6,77)/(groebnerMatrix(6,0)));
687 groebnerMatrix(35,78) = (groebnerMatrix(5,78)/(groebnerMatrix(5,0))-groebnerMatrix(6,78)/(groebnerMatrix(6,0)));
688 groebnerMatrix(35,79) = (groebnerMatrix(5,79)/(groebnerMatrix(5,0))-groebnerMatrix(6,79)/(groebnerMatrix(6,0)));
689 groebnerMatrix(35,80) = (groebnerMatrix(5,80)/(groebnerMatrix(5,0))-groebnerMatrix(6,80)/(groebnerMatrix(6,0)));
690 groebnerMatrix(35,81) = (groebnerMatrix(5,81)/(groebnerMatrix(5,0))-groebnerMatrix(6,81)/(groebnerMatrix(6,0)));
691 groebnerMatrix(35,82) = (groebnerMatrix(5,82)/(groebnerMatrix(5,0))-groebnerMatrix(6,82)/(groebnerMatrix(6,0)));
692 groebnerMatrix(35,83) = (groebnerMatrix(5,83)/(groebnerMatrix(5,0))-groebnerMatrix(6,83)/(groebnerMatrix(6,0)));
693 groebnerMatrix(35,84) = (groebnerMatrix(5,84)/(groebnerMatrix(5,0))-groebnerMatrix(6,84)/(groebnerMatrix(6,0)));
694 groebnerMatrix(35,85) = (groebnerMatrix(5,85)/(groebnerMatrix(5,0))-groebnerMatrix(6,85)/(groebnerMatrix(6,0)));
695 groebnerMatrix(35,86) = (groebnerMatrix(5,86)/(groebnerMatrix(5,0))-groebnerMatrix(6,86)/(groebnerMatrix(6,0)));
696 groebnerMatrix(35,87) = (groebnerMatrix(5,87)/(groebnerMatrix(5,0))-groebnerMatrix(6,87)/(groebnerMatrix(6,0)));
697 groebnerMatrix(35,89) = (groebnerMatrix(5,89)/(groebnerMatrix(5,0))-groebnerMatrix(6,89)/(groebnerMatrix(6,0)));
698 groebnerMatrix(35,91) = (groebnerMatrix(5,91)/(groebnerMatrix(5,0))-groebnerMatrix(6,91)/(groebnerMatrix(6,0)));
699 groebnerMatrix(35,92) = (groebnerMatrix(5,92)/(groebnerMatrix(5,0))-groebnerMatrix(6,92)/(groebnerMatrix(6,0)));
700 groebnerMatrix(35,94) = (groebnerMatrix(5,94)/(groebnerMatrix(5,0))-groebnerMatrix(6,94)/(groebnerMatrix(6,0)));
701 groebnerMatrix(35,97) = (groebnerMatrix(5,97)/(groebnerMatrix(5,0))-groebnerMatrix(6,97)/(groebnerMatrix(6,0)));
702 groebnerMatrix(35,98) = (groebnerMatrix(5,98)/(groebnerMatrix(5,0))-groebnerMatrix(6,98)/(groebnerMatrix(6,0)));
703 groebnerMatrix(35,99) = (groebnerMatrix(5,99)/(groebnerMatrix(5,0))-groebnerMatrix(6,99)/(groebnerMatrix(6,0)));
704 groebnerMatrix(35,100) = (groebnerMatrix(5,100)/(groebnerMatrix(5,0))-groebnerMatrix(6,100)/(groebnerMatrix(6,0)));
705 groebnerMatrix(35,101) = (groebnerMatrix(5,101)/(groebnerMatrix(5,0))-groebnerMatrix(6,101)/(groebnerMatrix(6,0)));
706 groebnerMatrix(35,103) = (groebnerMatrix(5,103)/(groebnerMatrix(5,0))-groebnerMatrix(6,103)/(groebnerMatrix(6,0)));
707 groebnerMatrix(35,104) = (groebnerMatrix(5,104)/(groebnerMatrix(5,0))-groebnerMatrix(6,104)/(groebnerMatrix(6,0)));
708 groebnerMatrix(35,105) = (groebnerMatrix(5,105)/(groebnerMatrix(5,0))-groebnerMatrix(6,105)/(groebnerMatrix(6,0)));
709 groebnerMatrix(35,106) = (groebnerMatrix(5,106)/(groebnerMatrix(5,0))-groebnerMatrix(6,106)/(groebnerMatrix(6,0)));
710 groebnerMatrix(35,107) = (groebnerMatrix(5,107)/(groebnerMatrix(5,0))-groebnerMatrix(6,107)/(groebnerMatrix(6,0)));
711 groebnerMatrix(35,108) = (groebnerMatrix(5,108)/(groebnerMatrix(5,0))-groebnerMatrix(6,108)/(groebnerMatrix(6,0)));
712 groebnerMatrix(35,109) = (groebnerMatrix(5,109)/(groebnerMatrix(5,0))-groebnerMatrix(6,109)/(groebnerMatrix(6,0)));
713 groebnerMatrix(35,110) = (groebnerMatrix(5,110)/(groebnerMatrix(5,0))-groebnerMatrix(6,110)/(groebnerMatrix(6,0)));
714 groebnerMatrix(35,111) = (groebnerMatrix(5,111)/(groebnerMatrix(5,0))-groebnerMatrix(6,111)/(groebnerMatrix(6,0)));
715 groebnerMatrix(35,112) = (groebnerMatrix(5,112)/(groebnerMatrix(5,0))-groebnerMatrix(6,112)/(groebnerMatrix(6,0)));
716 groebnerMatrix(35,113) = (groebnerMatrix(5,113)/(groebnerMatrix(5,0))-groebnerMatrix(6,113)/(groebnerMatrix(6,0)));
717 groebnerMatrix(35,115) = (groebnerMatrix(5,115)/(groebnerMatrix(5,0))-groebnerMatrix(6,115)/(groebnerMatrix(6,0)));
718 groebnerMatrix(35,116) = (groebnerMatrix(5,116)/(groebnerMatrix(5,0))-groebnerMatrix(6,116)/(groebnerMatrix(6,0)));
719 groebnerMatrix(35,118) = (groebnerMatrix(5,118)/(groebnerMatrix(5,0))-groebnerMatrix(6,118)/(groebnerMatrix(6,0)));
720 groebnerMatrix(35,119) = (groebnerMatrix(5,119)/(groebnerMatrix(5,0))-groebnerMatrix(6,119)/(groebnerMatrix(6,0)));
721 groebnerMatrix(35,120) = (groebnerMatrix(5,120)/(groebnerMatrix(5,0))-groebnerMatrix(6,120)/(groebnerMatrix(6,0)));
722 groebnerMatrix(35,121) = (groebnerMatrix(5,121)/(groebnerMatrix(5,0))-groebnerMatrix(6,121)/(groebnerMatrix(6,0)));
723 groebnerMatrix(35,122) = (groebnerMatrix(5,122)/(groebnerMatrix(5,0))-groebnerMatrix(6,122)/(groebnerMatrix(6,0)));
724 groebnerMatrix(35,123) = (groebnerMatrix(5,123)/(groebnerMatrix(5,0))-groebnerMatrix(6,123)/(groebnerMatrix(6,0)));
725 groebnerMatrix(35,125) = (groebnerMatrix(5,125)/(groebnerMatrix(5,0))-groebnerMatrix(6,125)/(groebnerMatrix(6,0)));
726 groebnerMatrix(35,126) = (groebnerMatrix(5,126)/(groebnerMatrix(5,0))-groebnerMatrix(6,126)/(groebnerMatrix(6,0)));
727 groebnerMatrix(35,127) = (groebnerMatrix(5,127)/(groebnerMatrix(5,0))-groebnerMatrix(6,127)/(groebnerMatrix(6,0)));
728 groebnerMatrix(35,128) = (groebnerMatrix(5,128)/(groebnerMatrix(5,0))-groebnerMatrix(6,128)/(groebnerMatrix(6,0)));
729 groebnerMatrix(35,129) = (groebnerMatrix(5,129)/(groebnerMatrix(5,0))-groebnerMatrix(6,129)/(groebnerMatrix(6,0)));
730 groebnerMatrix(35,130) = (groebnerMatrix(5,130)/(groebnerMatrix(5,0))-groebnerMatrix(6,130)/(groebnerMatrix(6,0)));
731 groebnerMatrix(35,133) = (groebnerMatrix(5,133)/(groebnerMatrix(5,0))-groebnerMatrix(6,133)/(groebnerMatrix(6,0)));
732 groebnerMatrix(35,134) = (groebnerMatrix(5,134)/(groebnerMatrix(5,0))-groebnerMatrix(6,134)/(groebnerMatrix(6,0)));
733 groebnerMatrix(35,136) = (groebnerMatrix(5,136)/(groebnerMatrix(5,0))-groebnerMatrix(6,136)/(groebnerMatrix(6,0)));
734 groebnerMatrix(35,137) = (groebnerMatrix(5,137)/(groebnerMatrix(5,0))-groebnerMatrix(6,137)/(groebnerMatrix(6,0)));
735 }
736
737 void
sPolynomial36(Eigen::Matrix<double,66,197> & groebnerMatrix)738 opengv::relative_pose::modules::fivept_kneip::sPolynomial36( Eigen::Matrix<double,66,197> & groebnerMatrix )
739 {
740 groebnerMatrix(36,1) = (groebnerMatrix(6,1)/(groebnerMatrix(6,0))-groebnerMatrix(7,1)/(groebnerMatrix(7,0)));
741 groebnerMatrix(36,2) = (groebnerMatrix(6,2)/(groebnerMatrix(6,0))-groebnerMatrix(7,2)/(groebnerMatrix(7,0)));
742 groebnerMatrix(36,3) = (groebnerMatrix(6,3)/(groebnerMatrix(6,0))-groebnerMatrix(7,3)/(groebnerMatrix(7,0)));
743 groebnerMatrix(36,4) = (groebnerMatrix(6,4)/(groebnerMatrix(6,0))-groebnerMatrix(7,4)/(groebnerMatrix(7,0)));
744 groebnerMatrix(36,5) = (groebnerMatrix(6,5)/(groebnerMatrix(6,0))-groebnerMatrix(7,5)/(groebnerMatrix(7,0)));
745 groebnerMatrix(36,6) = (groebnerMatrix(6,6)/(groebnerMatrix(6,0))-groebnerMatrix(7,6)/(groebnerMatrix(7,0)));
746 groebnerMatrix(36,8) = (groebnerMatrix(6,8)/(groebnerMatrix(6,0))-groebnerMatrix(7,8)/(groebnerMatrix(7,0)));
747 groebnerMatrix(36,10) = (groebnerMatrix(6,10)/(groebnerMatrix(6,0))-groebnerMatrix(7,10)/(groebnerMatrix(7,0)));
748 groebnerMatrix(36,11) = (groebnerMatrix(6,11)/(groebnerMatrix(6,0))-groebnerMatrix(7,11)/(groebnerMatrix(7,0)));
749 groebnerMatrix(36,12) = (groebnerMatrix(6,12)/(groebnerMatrix(6,0))-groebnerMatrix(7,12)/(groebnerMatrix(7,0)));
750 groebnerMatrix(36,13) = (groebnerMatrix(6,13)/(groebnerMatrix(6,0))-groebnerMatrix(7,13)/(groebnerMatrix(7,0)));
751 groebnerMatrix(36,14) = (groebnerMatrix(6,14)/(groebnerMatrix(6,0))-groebnerMatrix(7,14)/(groebnerMatrix(7,0)));
752 groebnerMatrix(36,15) = (groebnerMatrix(6,15)/(groebnerMatrix(6,0))-groebnerMatrix(7,15)/(groebnerMatrix(7,0)));
753 groebnerMatrix(36,16) = (groebnerMatrix(6,16)/(groebnerMatrix(6,0))-groebnerMatrix(7,16)/(groebnerMatrix(7,0)));
754 groebnerMatrix(36,18) = (groebnerMatrix(6,18)/(groebnerMatrix(6,0))-groebnerMatrix(7,18)/(groebnerMatrix(7,0)));
755 groebnerMatrix(36,19) = (groebnerMatrix(6,19)/(groebnerMatrix(6,0))-groebnerMatrix(7,19)/(groebnerMatrix(7,0)));
756 groebnerMatrix(36,20) = (groebnerMatrix(6,20)/(groebnerMatrix(6,0))-groebnerMatrix(7,20)/(groebnerMatrix(7,0)));
757 groebnerMatrix(36,21) = (groebnerMatrix(6,21)/(groebnerMatrix(6,0))-groebnerMatrix(7,21)/(groebnerMatrix(7,0)));
758 groebnerMatrix(36,22) = (groebnerMatrix(6,22)/(groebnerMatrix(6,0))-groebnerMatrix(7,22)/(groebnerMatrix(7,0)));
759 groebnerMatrix(36,23) = (groebnerMatrix(6,23)/(groebnerMatrix(6,0))-groebnerMatrix(7,23)/(groebnerMatrix(7,0)));
760 groebnerMatrix(36,25) = (groebnerMatrix(6,25)/(groebnerMatrix(6,0))-groebnerMatrix(7,25)/(groebnerMatrix(7,0)));
761 groebnerMatrix(36,26) = (groebnerMatrix(6,26)/(groebnerMatrix(6,0))-groebnerMatrix(7,26)/(groebnerMatrix(7,0)));
762 groebnerMatrix(36,27) = (groebnerMatrix(6,27)/(groebnerMatrix(6,0))-groebnerMatrix(7,27)/(groebnerMatrix(7,0)));
763 groebnerMatrix(36,28) = (groebnerMatrix(6,28)/(groebnerMatrix(6,0))-groebnerMatrix(7,28)/(groebnerMatrix(7,0)));
764 groebnerMatrix(36,29) = (groebnerMatrix(6,29)/(groebnerMatrix(6,0))-groebnerMatrix(7,29)/(groebnerMatrix(7,0)));
765 groebnerMatrix(36,30) = (groebnerMatrix(6,30)/(groebnerMatrix(6,0))-groebnerMatrix(7,30)/(groebnerMatrix(7,0)));
766 groebnerMatrix(36,33) = (groebnerMatrix(6,33)/(groebnerMatrix(6,0))-groebnerMatrix(7,33)/(groebnerMatrix(7,0)));
767 groebnerMatrix(36,34) = (groebnerMatrix(6,34)/(groebnerMatrix(6,0))-groebnerMatrix(7,34)/(groebnerMatrix(7,0)));
768 groebnerMatrix(36,39) = (groebnerMatrix(6,39)/(groebnerMatrix(6,0))-groebnerMatrix(7,39)/(groebnerMatrix(7,0)));
769 groebnerMatrix(36,40) = (groebnerMatrix(6,40)/(groebnerMatrix(6,0))-groebnerMatrix(7,40)/(groebnerMatrix(7,0)));
770 groebnerMatrix(36,41) = (groebnerMatrix(6,41)/(groebnerMatrix(6,0))-groebnerMatrix(7,41)/(groebnerMatrix(7,0)));
771 groebnerMatrix(36,42) = (groebnerMatrix(6,42)/(groebnerMatrix(6,0))-groebnerMatrix(7,42)/(groebnerMatrix(7,0)));
772 groebnerMatrix(36,43) = (groebnerMatrix(6,43)/(groebnerMatrix(6,0))-groebnerMatrix(7,43)/(groebnerMatrix(7,0)));
773 groebnerMatrix(36,44) = (groebnerMatrix(6,44)/(groebnerMatrix(6,0))-groebnerMatrix(7,44)/(groebnerMatrix(7,0)));
774 groebnerMatrix(36,45) = (groebnerMatrix(6,45)/(groebnerMatrix(6,0))-groebnerMatrix(7,45)/(groebnerMatrix(7,0)));
775 groebnerMatrix(36,46) = (groebnerMatrix(6,46)/(groebnerMatrix(6,0))-groebnerMatrix(7,46)/(groebnerMatrix(7,0)));
776 groebnerMatrix(36,47) = (groebnerMatrix(6,47)/(groebnerMatrix(6,0))-groebnerMatrix(7,47)/(groebnerMatrix(7,0)));
777 groebnerMatrix(36,48) = (groebnerMatrix(6,48)/(groebnerMatrix(6,0))-groebnerMatrix(7,48)/(groebnerMatrix(7,0)));
778 groebnerMatrix(36,49) = (groebnerMatrix(6,49)/(groebnerMatrix(6,0))-groebnerMatrix(7,49)/(groebnerMatrix(7,0)));
779 groebnerMatrix(36,50) = (groebnerMatrix(6,50)/(groebnerMatrix(6,0))-groebnerMatrix(7,50)/(groebnerMatrix(7,0)));
780 groebnerMatrix(36,51) = (groebnerMatrix(6,51)/(groebnerMatrix(6,0))-groebnerMatrix(7,51)/(groebnerMatrix(7,0)));
781 groebnerMatrix(36,52) = (groebnerMatrix(6,52)/(groebnerMatrix(6,0))-groebnerMatrix(7,52)/(groebnerMatrix(7,0)));
782 groebnerMatrix(36,53) = (groebnerMatrix(6,53)/(groebnerMatrix(6,0))-groebnerMatrix(7,53)/(groebnerMatrix(7,0)));
783 groebnerMatrix(36,54) = (groebnerMatrix(6,54)/(groebnerMatrix(6,0))-groebnerMatrix(7,54)/(groebnerMatrix(7,0)));
784 groebnerMatrix(36,55) = (groebnerMatrix(6,55)/(groebnerMatrix(6,0))-groebnerMatrix(7,55)/(groebnerMatrix(7,0)));
785 groebnerMatrix(36,56) = (groebnerMatrix(6,56)/(groebnerMatrix(6,0))-groebnerMatrix(7,56)/(groebnerMatrix(7,0)));
786 groebnerMatrix(36,57) = (groebnerMatrix(6,57)/(groebnerMatrix(6,0))-groebnerMatrix(7,57)/(groebnerMatrix(7,0)));
787 groebnerMatrix(36,58) = (groebnerMatrix(6,58)/(groebnerMatrix(6,0))-groebnerMatrix(7,58)/(groebnerMatrix(7,0)));
788 groebnerMatrix(36,59) = (groebnerMatrix(6,59)/(groebnerMatrix(6,0))-groebnerMatrix(7,59)/(groebnerMatrix(7,0)));
789 groebnerMatrix(36,60) = (groebnerMatrix(6,60)/(groebnerMatrix(6,0))-groebnerMatrix(7,60)/(groebnerMatrix(7,0)));
790 groebnerMatrix(36,61) = (groebnerMatrix(6,61)/(groebnerMatrix(6,0))-groebnerMatrix(7,61)/(groebnerMatrix(7,0)));
791 groebnerMatrix(36,62) = (groebnerMatrix(6,62)/(groebnerMatrix(6,0))-groebnerMatrix(7,62)/(groebnerMatrix(7,0)));
792 groebnerMatrix(36,64) = (groebnerMatrix(6,64)/(groebnerMatrix(6,0))-groebnerMatrix(7,64)/(groebnerMatrix(7,0)));
793 groebnerMatrix(36,65) = (groebnerMatrix(6,65)/(groebnerMatrix(6,0))-groebnerMatrix(7,65)/(groebnerMatrix(7,0)));
794 groebnerMatrix(36,66) = (groebnerMatrix(6,66)/(groebnerMatrix(6,0))-groebnerMatrix(7,66)/(groebnerMatrix(7,0)));
795 groebnerMatrix(36,67) = (groebnerMatrix(6,67)/(groebnerMatrix(6,0))-groebnerMatrix(7,67)/(groebnerMatrix(7,0)));
796 groebnerMatrix(36,68) = (groebnerMatrix(6,68)/(groebnerMatrix(6,0))-groebnerMatrix(7,68)/(groebnerMatrix(7,0)));
797 groebnerMatrix(36,69) = (groebnerMatrix(6,69)/(groebnerMatrix(6,0))-groebnerMatrix(7,69)/(groebnerMatrix(7,0)));
798 groebnerMatrix(36,70) = (groebnerMatrix(6,70)/(groebnerMatrix(6,0))-groebnerMatrix(7,70)/(groebnerMatrix(7,0)));
799 groebnerMatrix(36,71) = (groebnerMatrix(6,71)/(groebnerMatrix(6,0))-groebnerMatrix(7,71)/(groebnerMatrix(7,0)));
800 groebnerMatrix(36,73) = (groebnerMatrix(6,73)/(groebnerMatrix(6,0))-groebnerMatrix(7,73)/(groebnerMatrix(7,0)));
801 groebnerMatrix(36,74) = (groebnerMatrix(6,74)/(groebnerMatrix(6,0))-groebnerMatrix(7,74)/(groebnerMatrix(7,0)));
802 groebnerMatrix(36,76) = (groebnerMatrix(6,76)/(groebnerMatrix(6,0))-groebnerMatrix(7,76)/(groebnerMatrix(7,0)));
803 groebnerMatrix(36,77) = (groebnerMatrix(6,77)/(groebnerMatrix(6,0))-groebnerMatrix(7,77)/(groebnerMatrix(7,0)));
804 groebnerMatrix(36,78) = (groebnerMatrix(6,78)/(groebnerMatrix(6,0))-groebnerMatrix(7,78)/(groebnerMatrix(7,0)));
805 groebnerMatrix(36,79) = (groebnerMatrix(6,79)/(groebnerMatrix(6,0))-groebnerMatrix(7,79)/(groebnerMatrix(7,0)));
806 groebnerMatrix(36,80) = (groebnerMatrix(6,80)/(groebnerMatrix(6,0))-groebnerMatrix(7,80)/(groebnerMatrix(7,0)));
807 groebnerMatrix(36,81) = (groebnerMatrix(6,81)/(groebnerMatrix(6,0))-groebnerMatrix(7,81)/(groebnerMatrix(7,0)));
808 groebnerMatrix(36,82) = (groebnerMatrix(6,82)/(groebnerMatrix(6,0))-groebnerMatrix(7,82)/(groebnerMatrix(7,0)));
809 groebnerMatrix(36,83) = (groebnerMatrix(6,83)/(groebnerMatrix(6,0))-groebnerMatrix(7,83)/(groebnerMatrix(7,0)));
810 groebnerMatrix(36,84) = (groebnerMatrix(6,84)/(groebnerMatrix(6,0))-groebnerMatrix(7,84)/(groebnerMatrix(7,0)));
811 groebnerMatrix(36,85) = (groebnerMatrix(6,85)/(groebnerMatrix(6,0))-groebnerMatrix(7,85)/(groebnerMatrix(7,0)));
812 groebnerMatrix(36,86) = (groebnerMatrix(6,86)/(groebnerMatrix(6,0))-groebnerMatrix(7,86)/(groebnerMatrix(7,0)));
813 groebnerMatrix(36,87) = (groebnerMatrix(6,87)/(groebnerMatrix(6,0))-groebnerMatrix(7,87)/(groebnerMatrix(7,0)));
814 groebnerMatrix(36,89) = (groebnerMatrix(6,89)/(groebnerMatrix(6,0))-groebnerMatrix(7,89)/(groebnerMatrix(7,0)));
815 groebnerMatrix(36,91) = (groebnerMatrix(6,91)/(groebnerMatrix(6,0))-groebnerMatrix(7,91)/(groebnerMatrix(7,0)));
816 groebnerMatrix(36,92) = (groebnerMatrix(6,92)/(groebnerMatrix(6,0))-groebnerMatrix(7,92)/(groebnerMatrix(7,0)));
817 groebnerMatrix(36,94) = (groebnerMatrix(6,94)/(groebnerMatrix(6,0))-groebnerMatrix(7,94)/(groebnerMatrix(7,0)));
818 groebnerMatrix(36,97) = (groebnerMatrix(6,97)/(groebnerMatrix(6,0))-groebnerMatrix(7,97)/(groebnerMatrix(7,0)));
819 groebnerMatrix(36,98) = (groebnerMatrix(6,98)/(groebnerMatrix(6,0))-groebnerMatrix(7,98)/(groebnerMatrix(7,0)));
820 groebnerMatrix(36,99) = (groebnerMatrix(6,99)/(groebnerMatrix(6,0))-groebnerMatrix(7,99)/(groebnerMatrix(7,0)));
821 groebnerMatrix(36,100) = (groebnerMatrix(6,100)/(groebnerMatrix(6,0))-groebnerMatrix(7,100)/(groebnerMatrix(7,0)));
822 groebnerMatrix(36,101) = (groebnerMatrix(6,101)/(groebnerMatrix(6,0))-groebnerMatrix(7,101)/(groebnerMatrix(7,0)));
823 groebnerMatrix(36,103) = (groebnerMatrix(6,103)/(groebnerMatrix(6,0))-groebnerMatrix(7,103)/(groebnerMatrix(7,0)));
824 groebnerMatrix(36,104) = (groebnerMatrix(6,104)/(groebnerMatrix(6,0))-groebnerMatrix(7,104)/(groebnerMatrix(7,0)));
825 groebnerMatrix(36,105) = (groebnerMatrix(6,105)/(groebnerMatrix(6,0))-groebnerMatrix(7,105)/(groebnerMatrix(7,0)));
826 groebnerMatrix(36,106) = (groebnerMatrix(6,106)/(groebnerMatrix(6,0))-groebnerMatrix(7,106)/(groebnerMatrix(7,0)));
827 groebnerMatrix(36,107) = (groebnerMatrix(6,107)/(groebnerMatrix(6,0))-groebnerMatrix(7,107)/(groebnerMatrix(7,0)));
828 groebnerMatrix(36,108) = (groebnerMatrix(6,108)/(groebnerMatrix(6,0))-groebnerMatrix(7,108)/(groebnerMatrix(7,0)));
829 groebnerMatrix(36,109) = (groebnerMatrix(6,109)/(groebnerMatrix(6,0))-groebnerMatrix(7,109)/(groebnerMatrix(7,0)));
830 groebnerMatrix(36,110) = (groebnerMatrix(6,110)/(groebnerMatrix(6,0))-groebnerMatrix(7,110)/(groebnerMatrix(7,0)));
831 groebnerMatrix(36,111) = (groebnerMatrix(6,111)/(groebnerMatrix(6,0))-groebnerMatrix(7,111)/(groebnerMatrix(7,0)));
832 groebnerMatrix(36,112) = (groebnerMatrix(6,112)/(groebnerMatrix(6,0))-groebnerMatrix(7,112)/(groebnerMatrix(7,0)));
833 groebnerMatrix(36,113) = (groebnerMatrix(6,113)/(groebnerMatrix(6,0))-groebnerMatrix(7,113)/(groebnerMatrix(7,0)));
834 groebnerMatrix(36,115) = (groebnerMatrix(6,115)/(groebnerMatrix(6,0))-groebnerMatrix(7,115)/(groebnerMatrix(7,0)));
835 groebnerMatrix(36,116) = (groebnerMatrix(6,116)/(groebnerMatrix(6,0))-groebnerMatrix(7,116)/(groebnerMatrix(7,0)));
836 groebnerMatrix(36,118) = (groebnerMatrix(6,118)/(groebnerMatrix(6,0))-groebnerMatrix(7,118)/(groebnerMatrix(7,0)));
837 groebnerMatrix(36,119) = (groebnerMatrix(6,119)/(groebnerMatrix(6,0))-groebnerMatrix(7,119)/(groebnerMatrix(7,0)));
838 groebnerMatrix(36,120) = (groebnerMatrix(6,120)/(groebnerMatrix(6,0))-groebnerMatrix(7,120)/(groebnerMatrix(7,0)));
839 groebnerMatrix(36,121) = (groebnerMatrix(6,121)/(groebnerMatrix(6,0))-groebnerMatrix(7,121)/(groebnerMatrix(7,0)));
840 groebnerMatrix(36,122) = (groebnerMatrix(6,122)/(groebnerMatrix(6,0))-groebnerMatrix(7,122)/(groebnerMatrix(7,0)));
841 groebnerMatrix(36,123) = (groebnerMatrix(6,123)/(groebnerMatrix(6,0))-groebnerMatrix(7,123)/(groebnerMatrix(7,0)));
842 groebnerMatrix(36,125) = (groebnerMatrix(6,125)/(groebnerMatrix(6,0))-groebnerMatrix(7,125)/(groebnerMatrix(7,0)));
843 groebnerMatrix(36,126) = (groebnerMatrix(6,126)/(groebnerMatrix(6,0))-groebnerMatrix(7,126)/(groebnerMatrix(7,0)));
844 groebnerMatrix(36,127) = (groebnerMatrix(6,127)/(groebnerMatrix(6,0))-groebnerMatrix(7,127)/(groebnerMatrix(7,0)));
845 groebnerMatrix(36,128) = (groebnerMatrix(6,128)/(groebnerMatrix(6,0))-groebnerMatrix(7,128)/(groebnerMatrix(7,0)));
846 groebnerMatrix(36,129) = (groebnerMatrix(6,129)/(groebnerMatrix(6,0))-groebnerMatrix(7,129)/(groebnerMatrix(7,0)));
847 groebnerMatrix(36,130) = (groebnerMatrix(6,130)/(groebnerMatrix(6,0))-groebnerMatrix(7,130)/(groebnerMatrix(7,0)));
848 groebnerMatrix(36,133) = (groebnerMatrix(6,133)/(groebnerMatrix(6,0))-groebnerMatrix(7,133)/(groebnerMatrix(7,0)));
849 groebnerMatrix(36,134) = (groebnerMatrix(6,134)/(groebnerMatrix(6,0))-groebnerMatrix(7,134)/(groebnerMatrix(7,0)));
850 groebnerMatrix(36,136) = (groebnerMatrix(6,136)/(groebnerMatrix(6,0))-groebnerMatrix(7,136)/(groebnerMatrix(7,0)));
851 groebnerMatrix(36,137) = (groebnerMatrix(6,137)/(groebnerMatrix(6,0))-groebnerMatrix(7,137)/(groebnerMatrix(7,0)));
852 }
853
854 void
sPolynomial37(Eigen::Matrix<double,66,197> & groebnerMatrix)855 opengv::relative_pose::modules::fivept_kneip::sPolynomial37( Eigen::Matrix<double,66,197> & groebnerMatrix )
856 {
857 groebnerMatrix(37,1) = (groebnerMatrix(7,1)/(groebnerMatrix(7,0))-groebnerMatrix(8,1)/(groebnerMatrix(8,0)));
858 groebnerMatrix(37,2) = (groebnerMatrix(7,2)/(groebnerMatrix(7,0))-groebnerMatrix(8,2)/(groebnerMatrix(8,0)));
859 groebnerMatrix(37,3) = (groebnerMatrix(7,3)/(groebnerMatrix(7,0))-groebnerMatrix(8,3)/(groebnerMatrix(8,0)));
860 groebnerMatrix(37,4) = (groebnerMatrix(7,4)/(groebnerMatrix(7,0))-groebnerMatrix(8,4)/(groebnerMatrix(8,0)));
861 groebnerMatrix(37,5) = (groebnerMatrix(7,5)/(groebnerMatrix(7,0))-groebnerMatrix(8,5)/(groebnerMatrix(8,0)));
862 groebnerMatrix(37,6) = (groebnerMatrix(7,6)/(groebnerMatrix(7,0))-groebnerMatrix(8,6)/(groebnerMatrix(8,0)));
863 groebnerMatrix(37,8) = (groebnerMatrix(7,8)/(groebnerMatrix(7,0))-groebnerMatrix(8,8)/(groebnerMatrix(8,0)));
864 groebnerMatrix(37,10) = (groebnerMatrix(7,10)/(groebnerMatrix(7,0))-groebnerMatrix(8,10)/(groebnerMatrix(8,0)));
865 groebnerMatrix(37,11) = (groebnerMatrix(7,11)/(groebnerMatrix(7,0))-groebnerMatrix(8,11)/(groebnerMatrix(8,0)));
866 groebnerMatrix(37,12) = (groebnerMatrix(7,12)/(groebnerMatrix(7,0))-groebnerMatrix(8,12)/(groebnerMatrix(8,0)));
867 groebnerMatrix(37,13) = (groebnerMatrix(7,13)/(groebnerMatrix(7,0))-groebnerMatrix(8,13)/(groebnerMatrix(8,0)));
868 groebnerMatrix(37,14) = (groebnerMatrix(7,14)/(groebnerMatrix(7,0))-groebnerMatrix(8,14)/(groebnerMatrix(8,0)));
869 groebnerMatrix(37,15) = (groebnerMatrix(7,15)/(groebnerMatrix(7,0))-groebnerMatrix(8,15)/(groebnerMatrix(8,0)));
870 groebnerMatrix(37,16) = (groebnerMatrix(7,16)/(groebnerMatrix(7,0))-groebnerMatrix(8,16)/(groebnerMatrix(8,0)));
871 groebnerMatrix(37,18) = (groebnerMatrix(7,18)/(groebnerMatrix(7,0))-groebnerMatrix(8,18)/(groebnerMatrix(8,0)));
872 groebnerMatrix(37,19) = (groebnerMatrix(7,19)/(groebnerMatrix(7,0))-groebnerMatrix(8,19)/(groebnerMatrix(8,0)));
873 groebnerMatrix(37,20) = (groebnerMatrix(7,20)/(groebnerMatrix(7,0))-groebnerMatrix(8,20)/(groebnerMatrix(8,0)));
874 groebnerMatrix(37,21) = (groebnerMatrix(7,21)/(groebnerMatrix(7,0))-groebnerMatrix(8,21)/(groebnerMatrix(8,0)));
875 groebnerMatrix(37,22) = (groebnerMatrix(7,22)/(groebnerMatrix(7,0))-groebnerMatrix(8,22)/(groebnerMatrix(8,0)));
876 groebnerMatrix(37,23) = (groebnerMatrix(7,23)/(groebnerMatrix(7,0))-groebnerMatrix(8,23)/(groebnerMatrix(8,0)));
877 groebnerMatrix(37,25) = (groebnerMatrix(7,25)/(groebnerMatrix(7,0))-groebnerMatrix(8,25)/(groebnerMatrix(8,0)));
878 groebnerMatrix(37,26) = (groebnerMatrix(7,26)/(groebnerMatrix(7,0))-groebnerMatrix(8,26)/(groebnerMatrix(8,0)));
879 groebnerMatrix(37,27) = (groebnerMatrix(7,27)/(groebnerMatrix(7,0))-groebnerMatrix(8,27)/(groebnerMatrix(8,0)));
880 groebnerMatrix(37,28) = (groebnerMatrix(7,28)/(groebnerMatrix(7,0))-groebnerMatrix(8,28)/(groebnerMatrix(8,0)));
881 groebnerMatrix(37,29) = (groebnerMatrix(7,29)/(groebnerMatrix(7,0))-groebnerMatrix(8,29)/(groebnerMatrix(8,0)));
882 groebnerMatrix(37,30) = (groebnerMatrix(7,30)/(groebnerMatrix(7,0))-groebnerMatrix(8,30)/(groebnerMatrix(8,0)));
883 groebnerMatrix(37,33) = (groebnerMatrix(7,33)/(groebnerMatrix(7,0))-groebnerMatrix(8,33)/(groebnerMatrix(8,0)));
884 groebnerMatrix(37,34) = (groebnerMatrix(7,34)/(groebnerMatrix(7,0))-groebnerMatrix(8,34)/(groebnerMatrix(8,0)));
885 groebnerMatrix(37,39) = (groebnerMatrix(7,39)/(groebnerMatrix(7,0))-groebnerMatrix(8,39)/(groebnerMatrix(8,0)));
886 groebnerMatrix(37,40) = (groebnerMatrix(7,40)/(groebnerMatrix(7,0))-groebnerMatrix(8,40)/(groebnerMatrix(8,0)));
887 groebnerMatrix(37,41) = (groebnerMatrix(7,41)/(groebnerMatrix(7,0))-groebnerMatrix(8,41)/(groebnerMatrix(8,0)));
888 groebnerMatrix(37,42) = (groebnerMatrix(7,42)/(groebnerMatrix(7,0))-groebnerMatrix(8,42)/(groebnerMatrix(8,0)));
889 groebnerMatrix(37,43) = (groebnerMatrix(7,43)/(groebnerMatrix(7,0))-groebnerMatrix(8,43)/(groebnerMatrix(8,0)));
890 groebnerMatrix(37,44) = (groebnerMatrix(7,44)/(groebnerMatrix(7,0))-groebnerMatrix(8,44)/(groebnerMatrix(8,0)));
891 groebnerMatrix(37,45) = (groebnerMatrix(7,45)/(groebnerMatrix(7,0))-groebnerMatrix(8,45)/(groebnerMatrix(8,0)));
892 groebnerMatrix(37,46) = (groebnerMatrix(7,46)/(groebnerMatrix(7,0))-groebnerMatrix(8,46)/(groebnerMatrix(8,0)));
893 groebnerMatrix(37,47) = (groebnerMatrix(7,47)/(groebnerMatrix(7,0))-groebnerMatrix(8,47)/(groebnerMatrix(8,0)));
894 groebnerMatrix(37,48) = (groebnerMatrix(7,48)/(groebnerMatrix(7,0))-groebnerMatrix(8,48)/(groebnerMatrix(8,0)));
895 groebnerMatrix(37,49) = (groebnerMatrix(7,49)/(groebnerMatrix(7,0))-groebnerMatrix(8,49)/(groebnerMatrix(8,0)));
896 groebnerMatrix(37,50) = (groebnerMatrix(7,50)/(groebnerMatrix(7,0))-groebnerMatrix(8,50)/(groebnerMatrix(8,0)));
897 groebnerMatrix(37,51) = (groebnerMatrix(7,51)/(groebnerMatrix(7,0))-groebnerMatrix(8,51)/(groebnerMatrix(8,0)));
898 groebnerMatrix(37,52) = (groebnerMatrix(7,52)/(groebnerMatrix(7,0))-groebnerMatrix(8,52)/(groebnerMatrix(8,0)));
899 groebnerMatrix(37,53) = (groebnerMatrix(7,53)/(groebnerMatrix(7,0))-groebnerMatrix(8,53)/(groebnerMatrix(8,0)));
900 groebnerMatrix(37,54) = (groebnerMatrix(7,54)/(groebnerMatrix(7,0))-groebnerMatrix(8,54)/(groebnerMatrix(8,0)));
901 groebnerMatrix(37,55) = (groebnerMatrix(7,55)/(groebnerMatrix(7,0))-groebnerMatrix(8,55)/(groebnerMatrix(8,0)));
902 groebnerMatrix(37,56) = (groebnerMatrix(7,56)/(groebnerMatrix(7,0))-groebnerMatrix(8,56)/(groebnerMatrix(8,0)));
903 groebnerMatrix(37,57) = (groebnerMatrix(7,57)/(groebnerMatrix(7,0))-groebnerMatrix(8,57)/(groebnerMatrix(8,0)));
904 groebnerMatrix(37,58) = (groebnerMatrix(7,58)/(groebnerMatrix(7,0))-groebnerMatrix(8,58)/(groebnerMatrix(8,0)));
905 groebnerMatrix(37,59) = (groebnerMatrix(7,59)/(groebnerMatrix(7,0))-groebnerMatrix(8,59)/(groebnerMatrix(8,0)));
906 groebnerMatrix(37,60) = (groebnerMatrix(7,60)/(groebnerMatrix(7,0))-groebnerMatrix(8,60)/(groebnerMatrix(8,0)));
907 groebnerMatrix(37,61) = (groebnerMatrix(7,61)/(groebnerMatrix(7,0))-groebnerMatrix(8,61)/(groebnerMatrix(8,0)));
908 groebnerMatrix(37,62) = (groebnerMatrix(7,62)/(groebnerMatrix(7,0))-groebnerMatrix(8,62)/(groebnerMatrix(8,0)));
909 groebnerMatrix(37,64) = (groebnerMatrix(7,64)/(groebnerMatrix(7,0))-groebnerMatrix(8,64)/(groebnerMatrix(8,0)));
910 groebnerMatrix(37,65) = (groebnerMatrix(7,65)/(groebnerMatrix(7,0))-groebnerMatrix(8,65)/(groebnerMatrix(8,0)));
911 groebnerMatrix(37,66) = (groebnerMatrix(7,66)/(groebnerMatrix(7,0))-groebnerMatrix(8,66)/(groebnerMatrix(8,0)));
912 groebnerMatrix(37,67) = (groebnerMatrix(7,67)/(groebnerMatrix(7,0))-groebnerMatrix(8,67)/(groebnerMatrix(8,0)));
913 groebnerMatrix(37,68) = (groebnerMatrix(7,68)/(groebnerMatrix(7,0))-groebnerMatrix(8,68)/(groebnerMatrix(8,0)));
914 groebnerMatrix(37,69) = (groebnerMatrix(7,69)/(groebnerMatrix(7,0))-groebnerMatrix(8,69)/(groebnerMatrix(8,0)));
915 groebnerMatrix(37,70) = (groebnerMatrix(7,70)/(groebnerMatrix(7,0))-groebnerMatrix(8,70)/(groebnerMatrix(8,0)));
916 groebnerMatrix(37,71) = (groebnerMatrix(7,71)/(groebnerMatrix(7,0))-groebnerMatrix(8,71)/(groebnerMatrix(8,0)));
917 groebnerMatrix(37,73) = (groebnerMatrix(7,73)/(groebnerMatrix(7,0))-groebnerMatrix(8,73)/(groebnerMatrix(8,0)));
918 groebnerMatrix(37,74) = (groebnerMatrix(7,74)/(groebnerMatrix(7,0))-groebnerMatrix(8,74)/(groebnerMatrix(8,0)));
919 groebnerMatrix(37,76) = (groebnerMatrix(7,76)/(groebnerMatrix(7,0))-groebnerMatrix(8,76)/(groebnerMatrix(8,0)));
920 groebnerMatrix(37,77) = (groebnerMatrix(7,77)/(groebnerMatrix(7,0))-groebnerMatrix(8,77)/(groebnerMatrix(8,0)));
921 groebnerMatrix(37,78) = (groebnerMatrix(7,78)/(groebnerMatrix(7,0))-groebnerMatrix(8,78)/(groebnerMatrix(8,0)));
922 groebnerMatrix(37,79) = (groebnerMatrix(7,79)/(groebnerMatrix(7,0))-groebnerMatrix(8,79)/(groebnerMatrix(8,0)));
923 groebnerMatrix(37,80) = (groebnerMatrix(7,80)/(groebnerMatrix(7,0))-groebnerMatrix(8,80)/(groebnerMatrix(8,0)));
924 groebnerMatrix(37,81) = (groebnerMatrix(7,81)/(groebnerMatrix(7,0))-groebnerMatrix(8,81)/(groebnerMatrix(8,0)));
925 groebnerMatrix(37,82) = (groebnerMatrix(7,82)/(groebnerMatrix(7,0))-groebnerMatrix(8,82)/(groebnerMatrix(8,0)));
926 groebnerMatrix(37,83) = (groebnerMatrix(7,83)/(groebnerMatrix(7,0))-groebnerMatrix(8,83)/(groebnerMatrix(8,0)));
927 groebnerMatrix(37,84) = (groebnerMatrix(7,84)/(groebnerMatrix(7,0))-groebnerMatrix(8,84)/(groebnerMatrix(8,0)));
928 groebnerMatrix(37,85) = (groebnerMatrix(7,85)/(groebnerMatrix(7,0))-groebnerMatrix(8,85)/(groebnerMatrix(8,0)));
929 groebnerMatrix(37,86) = (groebnerMatrix(7,86)/(groebnerMatrix(7,0))-groebnerMatrix(8,86)/(groebnerMatrix(8,0)));
930 groebnerMatrix(37,87) = (groebnerMatrix(7,87)/(groebnerMatrix(7,0))-groebnerMatrix(8,87)/(groebnerMatrix(8,0)));
931 groebnerMatrix(37,89) = (groebnerMatrix(7,89)/(groebnerMatrix(7,0))-groebnerMatrix(8,89)/(groebnerMatrix(8,0)));
932 groebnerMatrix(37,91) = (groebnerMatrix(7,91)/(groebnerMatrix(7,0))-groebnerMatrix(8,91)/(groebnerMatrix(8,0)));
933 groebnerMatrix(37,92) = (groebnerMatrix(7,92)/(groebnerMatrix(7,0))-groebnerMatrix(8,92)/(groebnerMatrix(8,0)));
934 groebnerMatrix(37,94) = (groebnerMatrix(7,94)/(groebnerMatrix(7,0))-groebnerMatrix(8,94)/(groebnerMatrix(8,0)));
935 groebnerMatrix(37,97) = (groebnerMatrix(7,97)/(groebnerMatrix(7,0))-groebnerMatrix(8,97)/(groebnerMatrix(8,0)));
936 groebnerMatrix(37,98) = (groebnerMatrix(7,98)/(groebnerMatrix(7,0))-groebnerMatrix(8,98)/(groebnerMatrix(8,0)));
937 groebnerMatrix(37,99) = (groebnerMatrix(7,99)/(groebnerMatrix(7,0))-groebnerMatrix(8,99)/(groebnerMatrix(8,0)));
938 groebnerMatrix(37,100) = (groebnerMatrix(7,100)/(groebnerMatrix(7,0))-groebnerMatrix(8,100)/(groebnerMatrix(8,0)));
939 groebnerMatrix(37,101) = (groebnerMatrix(7,101)/(groebnerMatrix(7,0))-groebnerMatrix(8,101)/(groebnerMatrix(8,0)));
940 groebnerMatrix(37,103) = (groebnerMatrix(7,103)/(groebnerMatrix(7,0))-groebnerMatrix(8,103)/(groebnerMatrix(8,0)));
941 groebnerMatrix(37,104) = (groebnerMatrix(7,104)/(groebnerMatrix(7,0))-groebnerMatrix(8,104)/(groebnerMatrix(8,0)));
942 groebnerMatrix(37,105) = (groebnerMatrix(7,105)/(groebnerMatrix(7,0))-groebnerMatrix(8,105)/(groebnerMatrix(8,0)));
943 groebnerMatrix(37,106) = (groebnerMatrix(7,106)/(groebnerMatrix(7,0))-groebnerMatrix(8,106)/(groebnerMatrix(8,0)));
944 groebnerMatrix(37,107) = (groebnerMatrix(7,107)/(groebnerMatrix(7,0))-groebnerMatrix(8,107)/(groebnerMatrix(8,0)));
945 groebnerMatrix(37,108) = (groebnerMatrix(7,108)/(groebnerMatrix(7,0))-groebnerMatrix(8,108)/(groebnerMatrix(8,0)));
946 groebnerMatrix(37,109) = (groebnerMatrix(7,109)/(groebnerMatrix(7,0))-groebnerMatrix(8,109)/(groebnerMatrix(8,0)));
947 groebnerMatrix(37,110) = (groebnerMatrix(7,110)/(groebnerMatrix(7,0))-groebnerMatrix(8,110)/(groebnerMatrix(8,0)));
948 groebnerMatrix(37,111) = (groebnerMatrix(7,111)/(groebnerMatrix(7,0))-groebnerMatrix(8,111)/(groebnerMatrix(8,0)));
949 groebnerMatrix(37,112) = (groebnerMatrix(7,112)/(groebnerMatrix(7,0))-groebnerMatrix(8,112)/(groebnerMatrix(8,0)));
950 groebnerMatrix(37,113) = (groebnerMatrix(7,113)/(groebnerMatrix(7,0))-groebnerMatrix(8,113)/(groebnerMatrix(8,0)));
951 groebnerMatrix(37,115) = (groebnerMatrix(7,115)/(groebnerMatrix(7,0))-groebnerMatrix(8,115)/(groebnerMatrix(8,0)));
952 groebnerMatrix(37,116) = (groebnerMatrix(7,116)/(groebnerMatrix(7,0))-groebnerMatrix(8,116)/(groebnerMatrix(8,0)));
953 groebnerMatrix(37,118) = (groebnerMatrix(7,118)/(groebnerMatrix(7,0))-groebnerMatrix(8,118)/(groebnerMatrix(8,0)));
954 groebnerMatrix(37,119) = (groebnerMatrix(7,119)/(groebnerMatrix(7,0))-groebnerMatrix(8,119)/(groebnerMatrix(8,0)));
955 groebnerMatrix(37,120) = (groebnerMatrix(7,120)/(groebnerMatrix(7,0))-groebnerMatrix(8,120)/(groebnerMatrix(8,0)));
956 groebnerMatrix(37,121) = (groebnerMatrix(7,121)/(groebnerMatrix(7,0))-groebnerMatrix(8,121)/(groebnerMatrix(8,0)));
957 groebnerMatrix(37,122) = (groebnerMatrix(7,122)/(groebnerMatrix(7,0))-groebnerMatrix(8,122)/(groebnerMatrix(8,0)));
958 groebnerMatrix(37,123) = (groebnerMatrix(7,123)/(groebnerMatrix(7,0))-groebnerMatrix(8,123)/(groebnerMatrix(8,0)));
959 groebnerMatrix(37,125) = (groebnerMatrix(7,125)/(groebnerMatrix(7,0))-groebnerMatrix(8,125)/(groebnerMatrix(8,0)));
960 groebnerMatrix(37,126) = (groebnerMatrix(7,126)/(groebnerMatrix(7,0))-groebnerMatrix(8,126)/(groebnerMatrix(8,0)));
961 groebnerMatrix(37,127) = (groebnerMatrix(7,127)/(groebnerMatrix(7,0))-groebnerMatrix(8,127)/(groebnerMatrix(8,0)));
962 groebnerMatrix(37,128) = (groebnerMatrix(7,128)/(groebnerMatrix(7,0))-groebnerMatrix(8,128)/(groebnerMatrix(8,0)));
963 groebnerMatrix(37,129) = (groebnerMatrix(7,129)/(groebnerMatrix(7,0))-groebnerMatrix(8,129)/(groebnerMatrix(8,0)));
964 groebnerMatrix(37,130) = (groebnerMatrix(7,130)/(groebnerMatrix(7,0))-groebnerMatrix(8,130)/(groebnerMatrix(8,0)));
965 groebnerMatrix(37,133) = (groebnerMatrix(7,133)/(groebnerMatrix(7,0))-groebnerMatrix(8,133)/(groebnerMatrix(8,0)));
966 groebnerMatrix(37,134) = (groebnerMatrix(7,134)/(groebnerMatrix(7,0))-groebnerMatrix(8,134)/(groebnerMatrix(8,0)));
967 groebnerMatrix(37,136) = (groebnerMatrix(7,136)/(groebnerMatrix(7,0))-groebnerMatrix(8,136)/(groebnerMatrix(8,0)));
968 groebnerMatrix(37,137) = (groebnerMatrix(7,137)/(groebnerMatrix(7,0))-groebnerMatrix(8,137)/(groebnerMatrix(8,0)));
969 }
970
971 void
sPolynomial38(Eigen::Matrix<double,66,197> & groebnerMatrix)972 opengv::relative_pose::modules::fivept_kneip::sPolynomial38( Eigen::Matrix<double,66,197> & groebnerMatrix )
973 {
974 groebnerMatrix(38,1) = (groebnerMatrix(8,1)/(groebnerMatrix(8,0))-groebnerMatrix(9,1)/(groebnerMatrix(9,0)));
975 groebnerMatrix(38,2) = (groebnerMatrix(8,2)/(groebnerMatrix(8,0))-groebnerMatrix(9,2)/(groebnerMatrix(9,0)));
976 groebnerMatrix(38,3) = (groebnerMatrix(8,3)/(groebnerMatrix(8,0))-groebnerMatrix(9,3)/(groebnerMatrix(9,0)));
977 groebnerMatrix(38,4) = (groebnerMatrix(8,4)/(groebnerMatrix(8,0))-groebnerMatrix(9,4)/(groebnerMatrix(9,0)));
978 groebnerMatrix(38,5) = (groebnerMatrix(8,5)/(groebnerMatrix(8,0))-groebnerMatrix(9,5)/(groebnerMatrix(9,0)));
979 groebnerMatrix(38,6) = (groebnerMatrix(8,6)/(groebnerMatrix(8,0))-groebnerMatrix(9,6)/(groebnerMatrix(9,0)));
980 groebnerMatrix(38,8) = (groebnerMatrix(8,8)/(groebnerMatrix(8,0))-groebnerMatrix(9,8)/(groebnerMatrix(9,0)));
981 groebnerMatrix(38,10) = (groebnerMatrix(8,10)/(groebnerMatrix(8,0))-groebnerMatrix(9,10)/(groebnerMatrix(9,0)));
982 groebnerMatrix(38,11) = (groebnerMatrix(8,11)/(groebnerMatrix(8,0))-groebnerMatrix(9,11)/(groebnerMatrix(9,0)));
983 groebnerMatrix(38,12) = (groebnerMatrix(8,12)/(groebnerMatrix(8,0))-groebnerMatrix(9,12)/(groebnerMatrix(9,0)));
984 groebnerMatrix(38,13) = (groebnerMatrix(8,13)/(groebnerMatrix(8,0))-groebnerMatrix(9,13)/(groebnerMatrix(9,0)));
985 groebnerMatrix(38,14) = (groebnerMatrix(8,14)/(groebnerMatrix(8,0))-groebnerMatrix(9,14)/(groebnerMatrix(9,0)));
986 groebnerMatrix(38,15) = (groebnerMatrix(8,15)/(groebnerMatrix(8,0))-groebnerMatrix(9,15)/(groebnerMatrix(9,0)));
987 groebnerMatrix(38,16) = (groebnerMatrix(8,16)/(groebnerMatrix(8,0))-groebnerMatrix(9,16)/(groebnerMatrix(9,0)));
988 groebnerMatrix(38,18) = (groebnerMatrix(8,18)/(groebnerMatrix(8,0))-groebnerMatrix(9,18)/(groebnerMatrix(9,0)));
989 groebnerMatrix(38,19) = (groebnerMatrix(8,19)/(groebnerMatrix(8,0))-groebnerMatrix(9,19)/(groebnerMatrix(9,0)));
990 groebnerMatrix(38,20) = (groebnerMatrix(8,20)/(groebnerMatrix(8,0))-groebnerMatrix(9,20)/(groebnerMatrix(9,0)));
991 groebnerMatrix(38,21) = (groebnerMatrix(8,21)/(groebnerMatrix(8,0))-groebnerMatrix(9,21)/(groebnerMatrix(9,0)));
992 groebnerMatrix(38,22) = (groebnerMatrix(8,22)/(groebnerMatrix(8,0))-groebnerMatrix(9,22)/(groebnerMatrix(9,0)));
993 groebnerMatrix(38,23) = (groebnerMatrix(8,23)/(groebnerMatrix(8,0))-groebnerMatrix(9,23)/(groebnerMatrix(9,0)));
994 groebnerMatrix(38,25) = (groebnerMatrix(8,25)/(groebnerMatrix(8,0))-groebnerMatrix(9,25)/(groebnerMatrix(9,0)));
995 groebnerMatrix(38,26) = (groebnerMatrix(8,26)/(groebnerMatrix(8,0))-groebnerMatrix(9,26)/(groebnerMatrix(9,0)));
996 groebnerMatrix(38,27) = (groebnerMatrix(8,27)/(groebnerMatrix(8,0))-groebnerMatrix(9,27)/(groebnerMatrix(9,0)));
997 groebnerMatrix(38,28) = (groebnerMatrix(8,28)/(groebnerMatrix(8,0))-groebnerMatrix(9,28)/(groebnerMatrix(9,0)));
998 groebnerMatrix(38,29) = (groebnerMatrix(8,29)/(groebnerMatrix(8,0))-groebnerMatrix(9,29)/(groebnerMatrix(9,0)));
999 groebnerMatrix(38,30) = (groebnerMatrix(8,30)/(groebnerMatrix(8,0))-groebnerMatrix(9,30)/(groebnerMatrix(9,0)));
1000 groebnerMatrix(38,33) = (groebnerMatrix(8,33)/(groebnerMatrix(8,0))-groebnerMatrix(9,33)/(groebnerMatrix(9,0)));
1001 groebnerMatrix(38,34) = (groebnerMatrix(8,34)/(groebnerMatrix(8,0))-groebnerMatrix(9,34)/(groebnerMatrix(9,0)));
1002 groebnerMatrix(38,39) = (groebnerMatrix(8,39)/(groebnerMatrix(8,0))-groebnerMatrix(9,39)/(groebnerMatrix(9,0)));
1003 groebnerMatrix(38,40) = (groebnerMatrix(8,40)/(groebnerMatrix(8,0))-groebnerMatrix(9,40)/(groebnerMatrix(9,0)));
1004 groebnerMatrix(38,41) = (groebnerMatrix(8,41)/(groebnerMatrix(8,0))-groebnerMatrix(9,41)/(groebnerMatrix(9,0)));
1005 groebnerMatrix(38,42) = (groebnerMatrix(8,42)/(groebnerMatrix(8,0))-groebnerMatrix(9,42)/(groebnerMatrix(9,0)));
1006 groebnerMatrix(38,43) = (groebnerMatrix(8,43)/(groebnerMatrix(8,0))-groebnerMatrix(9,43)/(groebnerMatrix(9,0)));
1007 groebnerMatrix(38,44) = (groebnerMatrix(8,44)/(groebnerMatrix(8,0))-groebnerMatrix(9,44)/(groebnerMatrix(9,0)));
1008 groebnerMatrix(38,45) = (groebnerMatrix(8,45)/(groebnerMatrix(8,0))-groebnerMatrix(9,45)/(groebnerMatrix(9,0)));
1009 groebnerMatrix(38,46) = (groebnerMatrix(8,46)/(groebnerMatrix(8,0))-groebnerMatrix(9,46)/(groebnerMatrix(9,0)));
1010 groebnerMatrix(38,47) = (groebnerMatrix(8,47)/(groebnerMatrix(8,0))-groebnerMatrix(9,47)/(groebnerMatrix(9,0)));
1011 groebnerMatrix(38,48) = (groebnerMatrix(8,48)/(groebnerMatrix(8,0))-groebnerMatrix(9,48)/(groebnerMatrix(9,0)));
1012 groebnerMatrix(38,49) = (groebnerMatrix(8,49)/(groebnerMatrix(8,0))-groebnerMatrix(9,49)/(groebnerMatrix(9,0)));
1013 groebnerMatrix(38,50) = (groebnerMatrix(8,50)/(groebnerMatrix(8,0))-groebnerMatrix(9,50)/(groebnerMatrix(9,0)));
1014 groebnerMatrix(38,51) = (groebnerMatrix(8,51)/(groebnerMatrix(8,0))-groebnerMatrix(9,51)/(groebnerMatrix(9,0)));
1015 groebnerMatrix(38,52) = (groebnerMatrix(8,52)/(groebnerMatrix(8,0))-groebnerMatrix(9,52)/(groebnerMatrix(9,0)));
1016 groebnerMatrix(38,53) = (groebnerMatrix(8,53)/(groebnerMatrix(8,0))-groebnerMatrix(9,53)/(groebnerMatrix(9,0)));
1017 groebnerMatrix(38,54) = (groebnerMatrix(8,54)/(groebnerMatrix(8,0))-groebnerMatrix(9,54)/(groebnerMatrix(9,0)));
1018 groebnerMatrix(38,55) = (groebnerMatrix(8,55)/(groebnerMatrix(8,0))-groebnerMatrix(9,55)/(groebnerMatrix(9,0)));
1019 groebnerMatrix(38,56) = (groebnerMatrix(8,56)/(groebnerMatrix(8,0))-groebnerMatrix(9,56)/(groebnerMatrix(9,0)));
1020 groebnerMatrix(38,57) = (groebnerMatrix(8,57)/(groebnerMatrix(8,0))-groebnerMatrix(9,57)/(groebnerMatrix(9,0)));
1021 groebnerMatrix(38,58) = (groebnerMatrix(8,58)/(groebnerMatrix(8,0))-groebnerMatrix(9,58)/(groebnerMatrix(9,0)));
1022 groebnerMatrix(38,59) = (groebnerMatrix(8,59)/(groebnerMatrix(8,0))-groebnerMatrix(9,59)/(groebnerMatrix(9,0)));
1023 groebnerMatrix(38,60) = (groebnerMatrix(8,60)/(groebnerMatrix(8,0))-groebnerMatrix(9,60)/(groebnerMatrix(9,0)));
1024 groebnerMatrix(38,61) = (groebnerMatrix(8,61)/(groebnerMatrix(8,0))-groebnerMatrix(9,61)/(groebnerMatrix(9,0)));
1025 groebnerMatrix(38,62) = (groebnerMatrix(8,62)/(groebnerMatrix(8,0))-groebnerMatrix(9,62)/(groebnerMatrix(9,0)));
1026 groebnerMatrix(38,64) = (groebnerMatrix(8,64)/(groebnerMatrix(8,0))-groebnerMatrix(9,64)/(groebnerMatrix(9,0)));
1027 groebnerMatrix(38,65) = (groebnerMatrix(8,65)/(groebnerMatrix(8,0))-groebnerMatrix(9,65)/(groebnerMatrix(9,0)));
1028 groebnerMatrix(38,66) = (groebnerMatrix(8,66)/(groebnerMatrix(8,0))-groebnerMatrix(9,66)/(groebnerMatrix(9,0)));
1029 groebnerMatrix(38,67) = (groebnerMatrix(8,67)/(groebnerMatrix(8,0))-groebnerMatrix(9,67)/(groebnerMatrix(9,0)));
1030 groebnerMatrix(38,68) = (groebnerMatrix(8,68)/(groebnerMatrix(8,0))-groebnerMatrix(9,68)/(groebnerMatrix(9,0)));
1031 groebnerMatrix(38,69) = (groebnerMatrix(8,69)/(groebnerMatrix(8,0))-groebnerMatrix(9,69)/(groebnerMatrix(9,0)));
1032 groebnerMatrix(38,70) = (groebnerMatrix(8,70)/(groebnerMatrix(8,0))-groebnerMatrix(9,70)/(groebnerMatrix(9,0)));
1033 groebnerMatrix(38,71) = (groebnerMatrix(8,71)/(groebnerMatrix(8,0))-groebnerMatrix(9,71)/(groebnerMatrix(9,0)));
1034 groebnerMatrix(38,73) = (groebnerMatrix(8,73)/(groebnerMatrix(8,0))-groebnerMatrix(9,73)/(groebnerMatrix(9,0)));
1035 groebnerMatrix(38,74) = (groebnerMatrix(8,74)/(groebnerMatrix(8,0))-groebnerMatrix(9,74)/(groebnerMatrix(9,0)));
1036 groebnerMatrix(38,76) = (groebnerMatrix(8,76)/(groebnerMatrix(8,0))-groebnerMatrix(9,76)/(groebnerMatrix(9,0)));
1037 groebnerMatrix(38,77) = (groebnerMatrix(8,77)/(groebnerMatrix(8,0))-groebnerMatrix(9,77)/(groebnerMatrix(9,0)));
1038 groebnerMatrix(38,78) = (groebnerMatrix(8,78)/(groebnerMatrix(8,0))-groebnerMatrix(9,78)/(groebnerMatrix(9,0)));
1039 groebnerMatrix(38,79) = (groebnerMatrix(8,79)/(groebnerMatrix(8,0))-groebnerMatrix(9,79)/(groebnerMatrix(9,0)));
1040 groebnerMatrix(38,80) = (groebnerMatrix(8,80)/(groebnerMatrix(8,0))-groebnerMatrix(9,80)/(groebnerMatrix(9,0)));
1041 groebnerMatrix(38,81) = (groebnerMatrix(8,81)/(groebnerMatrix(8,0))-groebnerMatrix(9,81)/(groebnerMatrix(9,0)));
1042 groebnerMatrix(38,82) = (groebnerMatrix(8,82)/(groebnerMatrix(8,0))-groebnerMatrix(9,82)/(groebnerMatrix(9,0)));
1043 groebnerMatrix(38,83) = (groebnerMatrix(8,83)/(groebnerMatrix(8,0))-groebnerMatrix(9,83)/(groebnerMatrix(9,0)));
1044 groebnerMatrix(38,84) = (groebnerMatrix(8,84)/(groebnerMatrix(8,0))-groebnerMatrix(9,84)/(groebnerMatrix(9,0)));
1045 groebnerMatrix(38,85) = (groebnerMatrix(8,85)/(groebnerMatrix(8,0))-groebnerMatrix(9,85)/(groebnerMatrix(9,0)));
1046 groebnerMatrix(38,86) = (groebnerMatrix(8,86)/(groebnerMatrix(8,0))-groebnerMatrix(9,86)/(groebnerMatrix(9,0)));
1047 groebnerMatrix(38,87) = (groebnerMatrix(8,87)/(groebnerMatrix(8,0))-groebnerMatrix(9,87)/(groebnerMatrix(9,0)));
1048 groebnerMatrix(38,89) = (groebnerMatrix(8,89)/(groebnerMatrix(8,0))-groebnerMatrix(9,89)/(groebnerMatrix(9,0)));
1049 groebnerMatrix(38,91) = (groebnerMatrix(8,91)/(groebnerMatrix(8,0))-groebnerMatrix(9,91)/(groebnerMatrix(9,0)));
1050 groebnerMatrix(38,92) = (groebnerMatrix(8,92)/(groebnerMatrix(8,0))-groebnerMatrix(9,92)/(groebnerMatrix(9,0)));
1051 groebnerMatrix(38,94) = (groebnerMatrix(8,94)/(groebnerMatrix(8,0))-groebnerMatrix(9,94)/(groebnerMatrix(9,0)));
1052 groebnerMatrix(38,97) = (groebnerMatrix(8,97)/(groebnerMatrix(8,0))-groebnerMatrix(9,97)/(groebnerMatrix(9,0)));
1053 groebnerMatrix(38,98) = (groebnerMatrix(8,98)/(groebnerMatrix(8,0))-groebnerMatrix(9,98)/(groebnerMatrix(9,0)));
1054 groebnerMatrix(38,99) = (groebnerMatrix(8,99)/(groebnerMatrix(8,0))-groebnerMatrix(9,99)/(groebnerMatrix(9,0)));
1055 groebnerMatrix(38,100) = (groebnerMatrix(8,100)/(groebnerMatrix(8,0))-groebnerMatrix(9,100)/(groebnerMatrix(9,0)));
1056 groebnerMatrix(38,101) = (groebnerMatrix(8,101)/(groebnerMatrix(8,0))-groebnerMatrix(9,101)/(groebnerMatrix(9,0)));
1057 groebnerMatrix(38,103) = (groebnerMatrix(8,103)/(groebnerMatrix(8,0))-groebnerMatrix(9,103)/(groebnerMatrix(9,0)));
1058 groebnerMatrix(38,104) = (groebnerMatrix(8,104)/(groebnerMatrix(8,0))-groebnerMatrix(9,104)/(groebnerMatrix(9,0)));
1059 groebnerMatrix(38,105) = (groebnerMatrix(8,105)/(groebnerMatrix(8,0))-groebnerMatrix(9,105)/(groebnerMatrix(9,0)));
1060 groebnerMatrix(38,106) = (groebnerMatrix(8,106)/(groebnerMatrix(8,0))-groebnerMatrix(9,106)/(groebnerMatrix(9,0)));
1061 groebnerMatrix(38,107) = (groebnerMatrix(8,107)/(groebnerMatrix(8,0))-groebnerMatrix(9,107)/(groebnerMatrix(9,0)));
1062 groebnerMatrix(38,108) = (groebnerMatrix(8,108)/(groebnerMatrix(8,0))-groebnerMatrix(9,108)/(groebnerMatrix(9,0)));
1063 groebnerMatrix(38,109) = (groebnerMatrix(8,109)/(groebnerMatrix(8,0))-groebnerMatrix(9,109)/(groebnerMatrix(9,0)));
1064 groebnerMatrix(38,110) = (groebnerMatrix(8,110)/(groebnerMatrix(8,0))-groebnerMatrix(9,110)/(groebnerMatrix(9,0)));
1065 groebnerMatrix(38,111) = (groebnerMatrix(8,111)/(groebnerMatrix(8,0))-groebnerMatrix(9,111)/(groebnerMatrix(9,0)));
1066 groebnerMatrix(38,112) = (groebnerMatrix(8,112)/(groebnerMatrix(8,0))-groebnerMatrix(9,112)/(groebnerMatrix(9,0)));
1067 groebnerMatrix(38,113) = (groebnerMatrix(8,113)/(groebnerMatrix(8,0))-groebnerMatrix(9,113)/(groebnerMatrix(9,0)));
1068 groebnerMatrix(38,115) = (groebnerMatrix(8,115)/(groebnerMatrix(8,0))-groebnerMatrix(9,115)/(groebnerMatrix(9,0)));
1069 groebnerMatrix(38,116) = (groebnerMatrix(8,116)/(groebnerMatrix(8,0))-groebnerMatrix(9,116)/(groebnerMatrix(9,0)));
1070 groebnerMatrix(38,118) = (groebnerMatrix(8,118)/(groebnerMatrix(8,0))-groebnerMatrix(9,118)/(groebnerMatrix(9,0)));
1071 groebnerMatrix(38,119) = (groebnerMatrix(8,119)/(groebnerMatrix(8,0))-groebnerMatrix(9,119)/(groebnerMatrix(9,0)));
1072 groebnerMatrix(38,120) = (groebnerMatrix(8,120)/(groebnerMatrix(8,0))-groebnerMatrix(9,120)/(groebnerMatrix(9,0)));
1073 groebnerMatrix(38,121) = (groebnerMatrix(8,121)/(groebnerMatrix(8,0))-groebnerMatrix(9,121)/(groebnerMatrix(9,0)));
1074 groebnerMatrix(38,122) = (groebnerMatrix(8,122)/(groebnerMatrix(8,0))-groebnerMatrix(9,122)/(groebnerMatrix(9,0)));
1075 groebnerMatrix(38,123) = (groebnerMatrix(8,123)/(groebnerMatrix(8,0))-groebnerMatrix(9,123)/(groebnerMatrix(9,0)));
1076 groebnerMatrix(38,125) = (groebnerMatrix(8,125)/(groebnerMatrix(8,0))-groebnerMatrix(9,125)/(groebnerMatrix(9,0)));
1077 groebnerMatrix(38,126) = (groebnerMatrix(8,126)/(groebnerMatrix(8,0))-groebnerMatrix(9,126)/(groebnerMatrix(9,0)));
1078 groebnerMatrix(38,127) = (groebnerMatrix(8,127)/(groebnerMatrix(8,0))-groebnerMatrix(9,127)/(groebnerMatrix(9,0)));
1079 groebnerMatrix(38,128) = (groebnerMatrix(8,128)/(groebnerMatrix(8,0))-groebnerMatrix(9,128)/(groebnerMatrix(9,0)));
1080 groebnerMatrix(38,129) = (groebnerMatrix(8,129)/(groebnerMatrix(8,0))-groebnerMatrix(9,129)/(groebnerMatrix(9,0)));
1081 groebnerMatrix(38,130) = (groebnerMatrix(8,130)/(groebnerMatrix(8,0))-groebnerMatrix(9,130)/(groebnerMatrix(9,0)));
1082 groebnerMatrix(38,133) = (groebnerMatrix(8,133)/(groebnerMatrix(8,0))-groebnerMatrix(9,133)/(groebnerMatrix(9,0)));
1083 groebnerMatrix(38,134) = (groebnerMatrix(8,134)/(groebnerMatrix(8,0))-groebnerMatrix(9,134)/(groebnerMatrix(9,0)));
1084 groebnerMatrix(38,136) = (groebnerMatrix(8,136)/(groebnerMatrix(8,0))-groebnerMatrix(9,136)/(groebnerMatrix(9,0)));
1085 groebnerMatrix(38,137) = (groebnerMatrix(8,137)/(groebnerMatrix(8,0))-groebnerMatrix(9,137)/(groebnerMatrix(9,0)));
1086 }
1087
1088 void
sPolynomial39(Eigen::Matrix<double,66,197> & groebnerMatrix)1089 opengv::relative_pose::modules::fivept_kneip::sPolynomial39( Eigen::Matrix<double,66,197> & groebnerMatrix )
1090 {
1091 groebnerMatrix(39,1) = groebnerMatrix(9,1)/(groebnerMatrix(9,0));
1092 groebnerMatrix(39,2) = groebnerMatrix(9,2)/(groebnerMatrix(9,0));
1093 groebnerMatrix(39,3) = groebnerMatrix(9,3)/(groebnerMatrix(9,0));
1094 groebnerMatrix(39,4) = groebnerMatrix(9,4)/(groebnerMatrix(9,0));
1095 groebnerMatrix(39,5) = groebnerMatrix(9,5)/(groebnerMatrix(9,0));
1096 groebnerMatrix(39,6) = groebnerMatrix(9,6)/(groebnerMatrix(9,0));
1097 groebnerMatrix(39,7) = groebnerMatrix(9,7)/(groebnerMatrix(9,0));
1098 groebnerMatrix(39,8) = groebnerMatrix(9,8)/(groebnerMatrix(9,0));
1099 groebnerMatrix(39,9) = -groebnerMatrix(14,153)/(groebnerMatrix(14,148));
1100 groebnerMatrix(39,10) = groebnerMatrix(9,10)/(groebnerMatrix(9,0));
1101 groebnerMatrix(39,11) = groebnerMatrix(9,11)/(groebnerMatrix(9,0));
1102 groebnerMatrix(39,12) = groebnerMatrix(9,12)/(groebnerMatrix(9,0));
1103 groebnerMatrix(39,13) = groebnerMatrix(9,13)/(groebnerMatrix(9,0));
1104 groebnerMatrix(39,14) = groebnerMatrix(9,14)/(groebnerMatrix(9,0));
1105 groebnerMatrix(39,15) = groebnerMatrix(9,15)/(groebnerMatrix(9,0));
1106 groebnerMatrix(39,16) = groebnerMatrix(9,16)/(groebnerMatrix(9,0));
1107 groebnerMatrix(39,18) = groebnerMatrix(9,18)/(groebnerMatrix(9,0));
1108 groebnerMatrix(39,19) = groebnerMatrix(9,19)/(groebnerMatrix(9,0));
1109 groebnerMatrix(39,20) = groebnerMatrix(9,20)/(groebnerMatrix(9,0));
1110 groebnerMatrix(39,21) = groebnerMatrix(9,21)/(groebnerMatrix(9,0));
1111 groebnerMatrix(39,22) = groebnerMatrix(9,22)/(groebnerMatrix(9,0));
1112 groebnerMatrix(39,23) = (groebnerMatrix(9,23)/(groebnerMatrix(9,0))-groebnerMatrix(14,159)/(groebnerMatrix(14,148)));
1113 groebnerMatrix(39,25) = groebnerMatrix(9,25)/(groebnerMatrix(9,0));
1114 groebnerMatrix(39,26) = groebnerMatrix(9,26)/(groebnerMatrix(9,0));
1115 groebnerMatrix(39,27) = groebnerMatrix(9,27)/(groebnerMatrix(9,0));
1116 groebnerMatrix(39,28) = groebnerMatrix(9,28)/(groebnerMatrix(9,0));
1117 groebnerMatrix(39,29) = groebnerMatrix(9,29)/(groebnerMatrix(9,0));
1118 groebnerMatrix(39,30) = groebnerMatrix(9,30)/(groebnerMatrix(9,0));
1119 groebnerMatrix(39,33) = groebnerMatrix(9,33)/(groebnerMatrix(9,0));
1120 groebnerMatrix(39,34) = groebnerMatrix(9,34)/(groebnerMatrix(9,0));
1121 groebnerMatrix(39,39) = groebnerMatrix(9,39)/(groebnerMatrix(9,0));
1122 groebnerMatrix(39,40) = groebnerMatrix(9,40)/(groebnerMatrix(9,0));
1123 groebnerMatrix(39,41) = groebnerMatrix(9,41)/(groebnerMatrix(9,0));
1124 groebnerMatrix(39,42) = groebnerMatrix(9,42)/(groebnerMatrix(9,0));
1125 groebnerMatrix(39,43) = groebnerMatrix(9,43)/(groebnerMatrix(9,0));
1126 groebnerMatrix(39,44) = groebnerMatrix(9,44)/(groebnerMatrix(9,0));
1127 groebnerMatrix(39,45) = groebnerMatrix(9,45)/(groebnerMatrix(9,0));
1128 groebnerMatrix(39,46) = groebnerMatrix(9,46)/(groebnerMatrix(9,0));
1129 groebnerMatrix(39,47) = groebnerMatrix(9,47)/(groebnerMatrix(9,0));
1130 groebnerMatrix(39,48) = groebnerMatrix(9,48)/(groebnerMatrix(9,0));
1131 groebnerMatrix(39,49) = groebnerMatrix(9,49)/(groebnerMatrix(9,0));
1132 groebnerMatrix(39,50) = groebnerMatrix(9,50)/(groebnerMatrix(9,0));
1133 groebnerMatrix(39,51) = groebnerMatrix(9,51)/(groebnerMatrix(9,0));
1134 groebnerMatrix(39,52) = groebnerMatrix(9,52)/(groebnerMatrix(9,0));
1135 groebnerMatrix(39,53) = groebnerMatrix(9,53)/(groebnerMatrix(9,0));
1136 groebnerMatrix(39,54) = groebnerMatrix(9,54)/(groebnerMatrix(9,0));
1137 groebnerMatrix(39,55) = groebnerMatrix(9,55)/(groebnerMatrix(9,0));
1138 groebnerMatrix(39,56) = groebnerMatrix(9,56)/(groebnerMatrix(9,0));
1139 groebnerMatrix(39,57) = groebnerMatrix(9,57)/(groebnerMatrix(9,0));
1140 groebnerMatrix(39,58) = groebnerMatrix(9,58)/(groebnerMatrix(9,0));
1141 groebnerMatrix(39,59) = groebnerMatrix(9,59)/(groebnerMatrix(9,0));
1142 groebnerMatrix(39,60) = groebnerMatrix(9,60)/(groebnerMatrix(9,0));
1143 groebnerMatrix(39,61) = groebnerMatrix(9,61)/(groebnerMatrix(9,0));
1144 groebnerMatrix(39,62) = groebnerMatrix(9,62)/(groebnerMatrix(9,0));
1145 groebnerMatrix(39,64) = groebnerMatrix(9,64)/(groebnerMatrix(9,0));
1146 groebnerMatrix(39,65) = groebnerMatrix(9,65)/(groebnerMatrix(9,0));
1147 groebnerMatrix(39,66) = groebnerMatrix(9,66)/(groebnerMatrix(9,0));
1148 groebnerMatrix(39,67) = groebnerMatrix(9,67)/(groebnerMatrix(9,0));
1149 groebnerMatrix(39,68) = groebnerMatrix(9,68)/(groebnerMatrix(9,0));
1150 groebnerMatrix(39,69) = groebnerMatrix(9,69)/(groebnerMatrix(9,0));
1151 groebnerMatrix(39,70) = groebnerMatrix(9,70)/(groebnerMatrix(9,0));
1152 groebnerMatrix(39,71) = groebnerMatrix(9,71)/(groebnerMatrix(9,0));
1153 groebnerMatrix(39,73) = groebnerMatrix(9,73)/(groebnerMatrix(9,0));
1154 groebnerMatrix(39,74) = groebnerMatrix(9,74)/(groebnerMatrix(9,0));
1155 groebnerMatrix(39,76) = groebnerMatrix(9,76)/(groebnerMatrix(9,0));
1156 groebnerMatrix(39,77) = groebnerMatrix(9,77)/(groebnerMatrix(9,0));
1157 groebnerMatrix(39,78) = groebnerMatrix(9,78)/(groebnerMatrix(9,0));
1158 groebnerMatrix(39,79) = groebnerMatrix(9,79)/(groebnerMatrix(9,0));
1159 groebnerMatrix(39,80) = groebnerMatrix(9,80)/(groebnerMatrix(9,0));
1160 groebnerMatrix(39,81) = groebnerMatrix(9,81)/(groebnerMatrix(9,0));
1161 groebnerMatrix(39,82) = groebnerMatrix(9,82)/(groebnerMatrix(9,0));
1162 groebnerMatrix(39,83) = groebnerMatrix(9,83)/(groebnerMatrix(9,0));
1163 groebnerMatrix(39,84) = groebnerMatrix(9,84)/(groebnerMatrix(9,0));
1164 groebnerMatrix(39,85) = groebnerMatrix(9,85)/(groebnerMatrix(9,0));
1165 groebnerMatrix(39,86) = groebnerMatrix(9,86)/(groebnerMatrix(9,0));
1166 groebnerMatrix(39,87) = groebnerMatrix(9,87)/(groebnerMatrix(9,0));
1167 groebnerMatrix(39,89) = groebnerMatrix(9,89)/(groebnerMatrix(9,0));
1168 groebnerMatrix(39,91) = groebnerMatrix(9,91)/(groebnerMatrix(9,0));
1169 groebnerMatrix(39,92) = groebnerMatrix(9,92)/(groebnerMatrix(9,0));
1170 groebnerMatrix(39,94) = groebnerMatrix(9,94)/(groebnerMatrix(9,0));
1171 groebnerMatrix(39,97) = groebnerMatrix(9,97)/(groebnerMatrix(9,0));
1172 groebnerMatrix(39,98) = groebnerMatrix(9,98)/(groebnerMatrix(9,0));
1173 groebnerMatrix(39,99) = groebnerMatrix(9,99)/(groebnerMatrix(9,0));
1174 groebnerMatrix(39,100) = groebnerMatrix(9,100)/(groebnerMatrix(9,0));
1175 groebnerMatrix(39,101) = groebnerMatrix(9,101)/(groebnerMatrix(9,0));
1176 groebnerMatrix(39,103) = groebnerMatrix(9,103)/(groebnerMatrix(9,0));
1177 groebnerMatrix(39,104) = groebnerMatrix(9,104)/(groebnerMatrix(9,0));
1178 groebnerMatrix(39,105) = groebnerMatrix(9,105)/(groebnerMatrix(9,0));
1179 groebnerMatrix(39,106) = groebnerMatrix(9,106)/(groebnerMatrix(9,0));
1180 groebnerMatrix(39,107) = groebnerMatrix(9,107)/(groebnerMatrix(9,0));
1181 groebnerMatrix(39,108) = groebnerMatrix(9,108)/(groebnerMatrix(9,0));
1182 groebnerMatrix(39,109) = groebnerMatrix(9,109)/(groebnerMatrix(9,0));
1183 groebnerMatrix(39,110) = groebnerMatrix(9,110)/(groebnerMatrix(9,0));
1184 groebnerMatrix(39,111) = groebnerMatrix(9,111)/(groebnerMatrix(9,0));
1185 groebnerMatrix(39,112) = groebnerMatrix(9,112)/(groebnerMatrix(9,0));
1186 groebnerMatrix(39,113) = groebnerMatrix(9,113)/(groebnerMatrix(9,0));
1187 groebnerMatrix(39,115) = groebnerMatrix(9,115)/(groebnerMatrix(9,0));
1188 groebnerMatrix(39,116) = groebnerMatrix(9,116)/(groebnerMatrix(9,0));
1189 groebnerMatrix(39,118) = groebnerMatrix(9,118)/(groebnerMatrix(9,0));
1190 groebnerMatrix(39,119) = groebnerMatrix(9,119)/(groebnerMatrix(9,0));
1191 groebnerMatrix(39,120) = groebnerMatrix(9,120)/(groebnerMatrix(9,0));
1192 groebnerMatrix(39,121) = groebnerMatrix(9,121)/(groebnerMatrix(9,0));
1193 groebnerMatrix(39,122) = groebnerMatrix(9,122)/(groebnerMatrix(9,0));
1194 groebnerMatrix(39,123) = groebnerMatrix(9,123)/(groebnerMatrix(9,0));
1195 groebnerMatrix(39,125) = groebnerMatrix(9,125)/(groebnerMatrix(9,0));
1196 groebnerMatrix(39,126) = groebnerMatrix(9,126)/(groebnerMatrix(9,0));
1197 groebnerMatrix(39,127) = groebnerMatrix(9,127)/(groebnerMatrix(9,0));
1198 groebnerMatrix(39,128) = groebnerMatrix(9,128)/(groebnerMatrix(9,0));
1199 groebnerMatrix(39,129) = groebnerMatrix(9,129)/(groebnerMatrix(9,0));
1200 groebnerMatrix(39,130) = groebnerMatrix(9,130)/(groebnerMatrix(9,0));
1201 groebnerMatrix(39,133) = groebnerMatrix(9,133)/(groebnerMatrix(9,0));
1202 groebnerMatrix(39,134) = groebnerMatrix(9,134)/(groebnerMatrix(9,0));
1203 groebnerMatrix(39,136) = groebnerMatrix(9,136)/(groebnerMatrix(9,0));
1204 groebnerMatrix(39,137) = groebnerMatrix(9,137)/(groebnerMatrix(9,0));
1205 }
1206
1207 void
sPolynomial40(Eigen::Matrix<double,66,197> & groebnerMatrix)1208 opengv::relative_pose::modules::fivept_kneip::sPolynomial40( Eigen::Matrix<double,66,197> & groebnerMatrix )
1209 {
1210 groebnerMatrix(40,89) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1211 groebnerMatrix(40,90) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1212 groebnerMatrix(40,92) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1213 groebnerMatrix(40,93) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1214 groebnerMatrix(40,95) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1215 groebnerMatrix(40,96) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1216 groebnerMatrix(40,116) = groebnerMatrix(18,182)/(groebnerMatrix(18,175));
1217 groebnerMatrix(40,125) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1218 groebnerMatrix(40,126) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1219 groebnerMatrix(40,127) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1220 groebnerMatrix(40,128) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1221 groebnerMatrix(40,129) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1222 groebnerMatrix(40,130) = -groebnerMatrix(39,183)/(groebnerMatrix(39,162));
1223 groebnerMatrix(40,131) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1224 groebnerMatrix(40,132) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1225 groebnerMatrix(40,140) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1226 groebnerMatrix(40,157) = groebnerMatrix(18,187)/(groebnerMatrix(18,175));
1227 groebnerMatrix(40,170) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1228 groebnerMatrix(40,171) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1229 groebnerMatrix(40,172) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1230 groebnerMatrix(40,173) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1231 groebnerMatrix(40,174) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1232 groebnerMatrix(40,175) = -groebnerMatrix(39,192)/(groebnerMatrix(39,162));
1233 groebnerMatrix(40,176) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1234 groebnerMatrix(40,177) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1235 groebnerMatrix(40,185) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1236 groebnerMatrix(40,194) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1237 }
1238
1239 void
sPolynomial41(Eigen::Matrix<double,66,197> & groebnerMatrix)1240 opengv::relative_pose::modules::fivept_kneip::sPolynomial41( Eigen::Matrix<double,66,197> & groebnerMatrix )
1241 {
1242 groebnerMatrix(41,81) = -groebnerMatrix(38,162)/(groebnerMatrix(38,161));
1243 groebnerMatrix(41,89) = -groebnerMatrix(38,170)/(groebnerMatrix(38,161));
1244 groebnerMatrix(41,90) = -groebnerMatrix(38,171)/(groebnerMatrix(38,161));
1245 groebnerMatrix(41,92) = -groebnerMatrix(38,173)/(groebnerMatrix(38,161));
1246 groebnerMatrix(41,93) = -groebnerMatrix(38,174)/(groebnerMatrix(38,161));
1247 groebnerMatrix(41,95) = -groebnerMatrix(38,176)/(groebnerMatrix(38,161));
1248 groebnerMatrix(41,96) = -groebnerMatrix(38,177)/(groebnerMatrix(38,161));
1249 groebnerMatrix(41,111) = groebnerMatrix(18,182)/(groebnerMatrix(18,175));
1250 groebnerMatrix(41,125) = -groebnerMatrix(38,178)/(groebnerMatrix(38,161));
1251 groebnerMatrix(41,126) = -groebnerMatrix(38,179)/(groebnerMatrix(38,161));
1252 groebnerMatrix(41,127) = -groebnerMatrix(38,180)/(groebnerMatrix(38,161));
1253 groebnerMatrix(41,128) = -groebnerMatrix(38,181)/(groebnerMatrix(38,161));
1254 groebnerMatrix(41,129) = -groebnerMatrix(38,182)/(groebnerMatrix(38,161));
1255 groebnerMatrix(41,130) = -groebnerMatrix(38,183)/(groebnerMatrix(38,161));
1256 groebnerMatrix(41,131) = -groebnerMatrix(38,184)/(groebnerMatrix(38,161));
1257 groebnerMatrix(41,132) = -groebnerMatrix(38,185)/(groebnerMatrix(38,161));
1258 groebnerMatrix(41,140) = -groebnerMatrix(38,186)/(groebnerMatrix(38,161));
1259 groebnerMatrix(41,152) = groebnerMatrix(18,187)/(groebnerMatrix(18,175));
1260 groebnerMatrix(41,170) = -groebnerMatrix(38,187)/(groebnerMatrix(38,161));
1261 groebnerMatrix(41,171) = -groebnerMatrix(38,188)/(groebnerMatrix(38,161));
1262 groebnerMatrix(41,172) = -groebnerMatrix(38,189)/(groebnerMatrix(38,161));
1263 groebnerMatrix(41,173) = -groebnerMatrix(38,190)/(groebnerMatrix(38,161));
1264 groebnerMatrix(41,174) = -groebnerMatrix(38,191)/(groebnerMatrix(38,161));
1265 groebnerMatrix(41,175) = -groebnerMatrix(38,192)/(groebnerMatrix(38,161));
1266 groebnerMatrix(41,176) = -groebnerMatrix(38,193)/(groebnerMatrix(38,161));
1267 groebnerMatrix(41,177) = -groebnerMatrix(38,194)/(groebnerMatrix(38,161));
1268 groebnerMatrix(41,185) = -groebnerMatrix(38,195)/(groebnerMatrix(38,161));
1269 groebnerMatrix(41,194) = -groebnerMatrix(38,196)/(groebnerMatrix(38,161));
1270 }
1271
1272 void
sPolynomial42(Eigen::Matrix<double,66,197> & groebnerMatrix)1273 opengv::relative_pose::modules::fivept_kneip::sPolynomial42( Eigen::Matrix<double,66,197> & groebnerMatrix )
1274 {
1275 groebnerMatrix(42,80) = -groebnerMatrix(37,161)/(groebnerMatrix(37,160));
1276 groebnerMatrix(42,81) = -groebnerMatrix(37,162)/(groebnerMatrix(37,160));
1277 groebnerMatrix(42,89) = -groebnerMatrix(37,170)/(groebnerMatrix(37,160));
1278 groebnerMatrix(42,90) = -groebnerMatrix(37,171)/(groebnerMatrix(37,160));
1279 groebnerMatrix(42,92) = -groebnerMatrix(37,173)/(groebnerMatrix(37,160));
1280 groebnerMatrix(42,93) = -groebnerMatrix(37,174)/(groebnerMatrix(37,160));
1281 groebnerMatrix(42,95) = -groebnerMatrix(37,176)/(groebnerMatrix(37,160));
1282 groebnerMatrix(42,96) = -groebnerMatrix(37,177)/(groebnerMatrix(37,160));
1283 groebnerMatrix(42,110) = groebnerMatrix(18,182)/(groebnerMatrix(18,175));
1284 groebnerMatrix(42,125) = -groebnerMatrix(37,178)/(groebnerMatrix(37,160));
1285 groebnerMatrix(42,126) = -groebnerMatrix(37,179)/(groebnerMatrix(37,160));
1286 groebnerMatrix(42,127) = -groebnerMatrix(37,180)/(groebnerMatrix(37,160));
1287 groebnerMatrix(42,128) = -groebnerMatrix(37,181)/(groebnerMatrix(37,160));
1288 groebnerMatrix(42,129) = -groebnerMatrix(37,182)/(groebnerMatrix(37,160));
1289 groebnerMatrix(42,130) = -groebnerMatrix(37,183)/(groebnerMatrix(37,160));
1290 groebnerMatrix(42,131) = -groebnerMatrix(37,184)/(groebnerMatrix(37,160));
1291 groebnerMatrix(42,132) = -groebnerMatrix(37,185)/(groebnerMatrix(37,160));
1292 groebnerMatrix(42,140) = -groebnerMatrix(37,186)/(groebnerMatrix(37,160));
1293 groebnerMatrix(42,148) = groebnerMatrix(18,187)/(groebnerMatrix(18,175));
1294 groebnerMatrix(42,170) = -groebnerMatrix(37,187)/(groebnerMatrix(37,160));
1295 groebnerMatrix(42,171) = -groebnerMatrix(37,188)/(groebnerMatrix(37,160));
1296 groebnerMatrix(42,172) = -groebnerMatrix(37,189)/(groebnerMatrix(37,160));
1297 groebnerMatrix(42,173) = -groebnerMatrix(37,190)/(groebnerMatrix(37,160));
1298 groebnerMatrix(42,174) = -groebnerMatrix(37,191)/(groebnerMatrix(37,160));
1299 groebnerMatrix(42,175) = -groebnerMatrix(37,192)/(groebnerMatrix(37,160));
1300 groebnerMatrix(42,176) = -groebnerMatrix(37,193)/(groebnerMatrix(37,160));
1301 groebnerMatrix(42,177) = -groebnerMatrix(37,194)/(groebnerMatrix(37,160));
1302 groebnerMatrix(42,185) = -groebnerMatrix(37,195)/(groebnerMatrix(37,160));
1303 groebnerMatrix(42,194) = -groebnerMatrix(37,196)/(groebnerMatrix(37,160));
1304 }
1305
1306 void
sPolynomial43(Eigen::Matrix<double,66,197> & groebnerMatrix)1307 opengv::relative_pose::modules::fivept_kneip::sPolynomial43( Eigen::Matrix<double,66,197> & groebnerMatrix )
1308 {
1309 groebnerMatrix(43,79) = -groebnerMatrix(36,160)/(groebnerMatrix(36,159));
1310 groebnerMatrix(43,80) = -groebnerMatrix(36,161)/(groebnerMatrix(36,159));
1311 groebnerMatrix(43,81) = -groebnerMatrix(36,162)/(groebnerMatrix(36,159));
1312 groebnerMatrix(43,89) = -groebnerMatrix(36,170)/(groebnerMatrix(36,159));
1313 groebnerMatrix(43,90) = -groebnerMatrix(36,171)/(groebnerMatrix(36,159));
1314 groebnerMatrix(43,92) = -groebnerMatrix(36,173)/(groebnerMatrix(36,159));
1315 groebnerMatrix(43,93) = -groebnerMatrix(36,174)/(groebnerMatrix(36,159));
1316 groebnerMatrix(43,95) = -groebnerMatrix(36,176)/(groebnerMatrix(36,159));
1317 groebnerMatrix(43,96) = -groebnerMatrix(36,177)/(groebnerMatrix(36,159));
1318 groebnerMatrix(43,113) = groebnerMatrix(17,179)/(groebnerMatrix(17,172));
1319 groebnerMatrix(43,125) = -groebnerMatrix(36,178)/(groebnerMatrix(36,159));
1320 groebnerMatrix(43,126) = -groebnerMatrix(36,179)/(groebnerMatrix(36,159));
1321 groebnerMatrix(43,127) = -groebnerMatrix(36,180)/(groebnerMatrix(36,159));
1322 groebnerMatrix(43,128) = -groebnerMatrix(36,181)/(groebnerMatrix(36,159));
1323 groebnerMatrix(43,129) = -groebnerMatrix(36,182)/(groebnerMatrix(36,159));
1324 groebnerMatrix(43,130) = -groebnerMatrix(36,183)/(groebnerMatrix(36,159));
1325 groebnerMatrix(43,131) = -groebnerMatrix(36,184)/(groebnerMatrix(36,159));
1326 groebnerMatrix(43,132) = -groebnerMatrix(36,185)/(groebnerMatrix(36,159));
1327 groebnerMatrix(43,140) = -groebnerMatrix(36,186)/(groebnerMatrix(36,159));
1328 groebnerMatrix(43,160) = groebnerMatrix(17,190)/(groebnerMatrix(17,172));
1329 groebnerMatrix(43,170) = -groebnerMatrix(36,187)/(groebnerMatrix(36,159));
1330 groebnerMatrix(43,171) = -groebnerMatrix(36,188)/(groebnerMatrix(36,159));
1331 groebnerMatrix(43,172) = -groebnerMatrix(36,189)/(groebnerMatrix(36,159));
1332 groebnerMatrix(43,173) = -groebnerMatrix(36,190)/(groebnerMatrix(36,159));
1333 groebnerMatrix(43,174) = -groebnerMatrix(36,191)/(groebnerMatrix(36,159));
1334 groebnerMatrix(43,175) = -groebnerMatrix(36,192)/(groebnerMatrix(36,159));
1335 groebnerMatrix(43,176) = -groebnerMatrix(36,193)/(groebnerMatrix(36,159));
1336 groebnerMatrix(43,177) = -groebnerMatrix(36,194)/(groebnerMatrix(36,159));
1337 groebnerMatrix(43,185) = -groebnerMatrix(36,195)/(groebnerMatrix(36,159));
1338 groebnerMatrix(43,194) = -groebnerMatrix(36,196)/(groebnerMatrix(36,159));
1339 }
1340
1341 void
sPolynomial44(Eigen::Matrix<double,66,197> & groebnerMatrix)1342 opengv::relative_pose::modules::fivept_kneip::sPolynomial44( Eigen::Matrix<double,66,197> & groebnerMatrix )
1343 {
1344 groebnerMatrix(44,78) = -groebnerMatrix(35,159)/(groebnerMatrix(35,158));
1345 groebnerMatrix(44,79) = -groebnerMatrix(35,160)/(groebnerMatrix(35,158));
1346 groebnerMatrix(44,80) = -groebnerMatrix(35,161)/(groebnerMatrix(35,158));
1347 groebnerMatrix(44,81) = -groebnerMatrix(35,162)/(groebnerMatrix(35,158));
1348 groebnerMatrix(44,89) = -groebnerMatrix(35,170)/(groebnerMatrix(35,158));
1349 groebnerMatrix(44,90) = -groebnerMatrix(35,171)/(groebnerMatrix(35,158));
1350 groebnerMatrix(44,92) = -groebnerMatrix(35,173)/(groebnerMatrix(35,158));
1351 groebnerMatrix(44,93) = -groebnerMatrix(35,174)/(groebnerMatrix(35,158));
1352 groebnerMatrix(44,95) = -groebnerMatrix(35,176)/(groebnerMatrix(35,158));
1353 groebnerMatrix(44,96) = -groebnerMatrix(35,177)/(groebnerMatrix(35,158));
1354 groebnerMatrix(44,108) = groebnerMatrix(18,182)/(groebnerMatrix(18,175));
1355 groebnerMatrix(44,125) = -groebnerMatrix(35,178)/(groebnerMatrix(35,158));
1356 groebnerMatrix(44,126) = -groebnerMatrix(35,179)/(groebnerMatrix(35,158));
1357 groebnerMatrix(44,127) = -groebnerMatrix(35,180)/(groebnerMatrix(35,158));
1358 groebnerMatrix(44,128) = -groebnerMatrix(35,181)/(groebnerMatrix(35,158));
1359 groebnerMatrix(44,129) = -groebnerMatrix(35,182)/(groebnerMatrix(35,158));
1360 groebnerMatrix(44,130) = -groebnerMatrix(35,183)/(groebnerMatrix(35,158));
1361 groebnerMatrix(44,131) = -groebnerMatrix(35,184)/(groebnerMatrix(35,158));
1362 groebnerMatrix(44,132) = -groebnerMatrix(35,185)/(groebnerMatrix(35,158));
1363 groebnerMatrix(44,140) = -groebnerMatrix(35,186)/(groebnerMatrix(35,158));
1364 groebnerMatrix(44,143) = groebnerMatrix(18,187)/(groebnerMatrix(18,175));
1365 groebnerMatrix(44,170) = -groebnerMatrix(35,187)/(groebnerMatrix(35,158));
1366 groebnerMatrix(44,171) = -groebnerMatrix(35,188)/(groebnerMatrix(35,158));
1367 groebnerMatrix(44,172) = -groebnerMatrix(35,189)/(groebnerMatrix(35,158));
1368 groebnerMatrix(44,173) = -groebnerMatrix(35,190)/(groebnerMatrix(35,158));
1369 groebnerMatrix(44,174) = -groebnerMatrix(35,191)/(groebnerMatrix(35,158));
1370 groebnerMatrix(44,175) = -groebnerMatrix(35,192)/(groebnerMatrix(35,158));
1371 groebnerMatrix(44,176) = -groebnerMatrix(35,193)/(groebnerMatrix(35,158));
1372 groebnerMatrix(44,177) = -groebnerMatrix(35,194)/(groebnerMatrix(35,158));
1373 groebnerMatrix(44,185) = -groebnerMatrix(35,195)/(groebnerMatrix(35,158));
1374 groebnerMatrix(44,194) = -groebnerMatrix(35,196)/(groebnerMatrix(35,158));
1375 }
1376
1377 void
sPolynomial45(Eigen::Matrix<double,66,197> & groebnerMatrix)1378 opengv::relative_pose::modules::fivept_kneip::sPolynomial45( Eigen::Matrix<double,66,197> & groebnerMatrix )
1379 {
1380 groebnerMatrix(45,77) = -groebnerMatrix(34,158)/(groebnerMatrix(34,157));
1381 groebnerMatrix(45,78) = -groebnerMatrix(34,159)/(groebnerMatrix(34,157));
1382 groebnerMatrix(45,79) = -groebnerMatrix(34,160)/(groebnerMatrix(34,157));
1383 groebnerMatrix(45,80) = -groebnerMatrix(34,161)/(groebnerMatrix(34,157));
1384 groebnerMatrix(45,81) = -groebnerMatrix(34,162)/(groebnerMatrix(34,157));
1385 groebnerMatrix(45,89) = -groebnerMatrix(34,170)/(groebnerMatrix(34,157));
1386 groebnerMatrix(45,90) = -groebnerMatrix(34,171)/(groebnerMatrix(34,157));
1387 groebnerMatrix(45,92) = -groebnerMatrix(34,173)/(groebnerMatrix(34,157));
1388 groebnerMatrix(45,93) = -groebnerMatrix(34,174)/(groebnerMatrix(34,157));
1389 groebnerMatrix(45,95) = -groebnerMatrix(34,176)/(groebnerMatrix(34,157));
1390 groebnerMatrix(45,96) = -groebnerMatrix(34,177)/(groebnerMatrix(34,157));
1391 groebnerMatrix(45,107) = groebnerMatrix(18,182)/(groebnerMatrix(18,175));
1392 groebnerMatrix(45,125) = -groebnerMatrix(34,178)/(groebnerMatrix(34,157));
1393 groebnerMatrix(45,126) = -groebnerMatrix(34,179)/(groebnerMatrix(34,157));
1394 groebnerMatrix(45,127) = -groebnerMatrix(34,180)/(groebnerMatrix(34,157));
1395 groebnerMatrix(45,128) = -groebnerMatrix(34,181)/(groebnerMatrix(34,157));
1396 groebnerMatrix(45,129) = -groebnerMatrix(34,182)/(groebnerMatrix(34,157));
1397 groebnerMatrix(45,130) = -groebnerMatrix(34,183)/(groebnerMatrix(34,157));
1398 groebnerMatrix(45,131) = -groebnerMatrix(34,184)/(groebnerMatrix(34,157));
1399 groebnerMatrix(45,132) = -groebnerMatrix(34,185)/(groebnerMatrix(34,157));
1400 groebnerMatrix(45,140) = -groebnerMatrix(34,186)/(groebnerMatrix(34,157));
1401 groebnerMatrix(45,142) = groebnerMatrix(18,187)/(groebnerMatrix(18,175));
1402 groebnerMatrix(45,170) = -groebnerMatrix(34,187)/(groebnerMatrix(34,157));
1403 groebnerMatrix(45,171) = -groebnerMatrix(34,188)/(groebnerMatrix(34,157));
1404 groebnerMatrix(45,172) = -groebnerMatrix(34,189)/(groebnerMatrix(34,157));
1405 groebnerMatrix(45,173) = -groebnerMatrix(34,190)/(groebnerMatrix(34,157));
1406 groebnerMatrix(45,174) = -groebnerMatrix(34,191)/(groebnerMatrix(34,157));
1407 groebnerMatrix(45,175) = -groebnerMatrix(34,192)/(groebnerMatrix(34,157));
1408 groebnerMatrix(45,176) = -groebnerMatrix(34,193)/(groebnerMatrix(34,157));
1409 groebnerMatrix(45,177) = -groebnerMatrix(34,194)/(groebnerMatrix(34,157));
1410 groebnerMatrix(45,185) = -groebnerMatrix(34,195)/(groebnerMatrix(34,157));
1411 groebnerMatrix(45,194) = -groebnerMatrix(34,196)/(groebnerMatrix(34,157));
1412 }
1413
1414 void
sPolynomial46(Eigen::Matrix<double,66,197> & groebnerMatrix)1415 opengv::relative_pose::modules::fivept_kneip::sPolynomial46( Eigen::Matrix<double,66,197> & groebnerMatrix )
1416 {
1417 groebnerMatrix(46,82) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1418 groebnerMatrix(46,83) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1419 groebnerMatrix(46,85) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1420 groebnerMatrix(46,86) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1421 groebnerMatrix(46,88) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1422 groebnerMatrix(46,95) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1423 groebnerMatrix(46,115) = groebnerMatrix(27,181)/(groebnerMatrix(27,168));
1424 groebnerMatrix(46,118) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1425 groebnerMatrix(46,119) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1426 groebnerMatrix(46,120) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1427 groebnerMatrix(46,121) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1428 groebnerMatrix(46,122) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1429 groebnerMatrix(46,123) = -groebnerMatrix(39,183)/(groebnerMatrix(39,162));
1430 groebnerMatrix(46,124) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1431 groebnerMatrix(46,131) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1432 groebnerMatrix(46,139) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1433 groebnerMatrix(46,158) = groebnerMatrix(27,188)/(groebnerMatrix(27,168));
1434 groebnerMatrix(46,163) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1435 groebnerMatrix(46,164) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1436 groebnerMatrix(46,165) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1437 groebnerMatrix(46,166) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1438 groebnerMatrix(46,167) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1439 groebnerMatrix(46,168) = -groebnerMatrix(39,192)/(groebnerMatrix(39,162));
1440 groebnerMatrix(46,169) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1441 groebnerMatrix(46,176) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1442 groebnerMatrix(46,184) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1443 groebnerMatrix(46,193) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1444 }
1445
1446 void
sPolynomial47(Eigen::Matrix<double,66,197> & groebnerMatrix)1447 opengv::relative_pose::modules::fivept_kneip::sPolynomial47( Eigen::Matrix<double,66,197> & groebnerMatrix )
1448 {
1449 groebnerMatrix(47,56) = -groebnerMatrix(38,162)/(groebnerMatrix(38,161));
1450 groebnerMatrix(47,79) = groebnerMatrix(21,173)/(groebnerMatrix(21,167));
1451 groebnerMatrix(47,82) = -groebnerMatrix(38,170)/(groebnerMatrix(38,161));
1452 groebnerMatrix(47,83) = -groebnerMatrix(38,171)/(groebnerMatrix(38,161));
1453 groebnerMatrix(47,85) = -groebnerMatrix(38,173)/(groebnerMatrix(38,161));
1454 groebnerMatrix(47,86) = -groebnerMatrix(38,174)/(groebnerMatrix(38,161));
1455 groebnerMatrix(47,88) = -groebnerMatrix(38,176)/(groebnerMatrix(38,161));
1456 groebnerMatrix(47,95) = -groebnerMatrix(38,177)/(groebnerMatrix(38,161));
1457 groebnerMatrix(47,118) = -groebnerMatrix(38,178)/(groebnerMatrix(38,161));
1458 groebnerMatrix(47,119) = -groebnerMatrix(38,179)/(groebnerMatrix(38,161));
1459 groebnerMatrix(47,120) = -groebnerMatrix(38,180)/(groebnerMatrix(38,161));
1460 groebnerMatrix(47,121) = -groebnerMatrix(38,181)/(groebnerMatrix(38,161));
1461 groebnerMatrix(47,122) = -groebnerMatrix(38,182)/(groebnerMatrix(38,161));
1462 groebnerMatrix(47,123) = -groebnerMatrix(38,183)/(groebnerMatrix(38,161));
1463 groebnerMatrix(47,124) = -groebnerMatrix(38,184)/(groebnerMatrix(38,161));
1464 groebnerMatrix(47,131) = -groebnerMatrix(38,185)/(groebnerMatrix(38,161));
1465 groebnerMatrix(47,139) = -groebnerMatrix(38,186)/(groebnerMatrix(38,161));
1466 groebnerMatrix(47,159) = groebnerMatrix(21,189)/(groebnerMatrix(21,167));
1467 groebnerMatrix(47,163) = -groebnerMatrix(38,187)/(groebnerMatrix(38,161));
1468 groebnerMatrix(47,164) = -groebnerMatrix(38,188)/(groebnerMatrix(38,161));
1469 groebnerMatrix(47,165) = -groebnerMatrix(38,189)/(groebnerMatrix(38,161));
1470 groebnerMatrix(47,166) = -groebnerMatrix(38,190)/(groebnerMatrix(38,161));
1471 groebnerMatrix(47,167) = -groebnerMatrix(38,191)/(groebnerMatrix(38,161));
1472 groebnerMatrix(47,168) = -groebnerMatrix(38,192)/(groebnerMatrix(38,161));
1473 groebnerMatrix(47,169) = -groebnerMatrix(38,193)/(groebnerMatrix(38,161));
1474 groebnerMatrix(47,176) = -groebnerMatrix(38,194)/(groebnerMatrix(38,161));
1475 groebnerMatrix(47,184) = -groebnerMatrix(38,195)/(groebnerMatrix(38,161));
1476 groebnerMatrix(47,193) = -groebnerMatrix(38,196)/(groebnerMatrix(38,161));
1477 }
1478
1479 void
sPolynomial48(Eigen::Matrix<double,66,197> & groebnerMatrix)1480 opengv::relative_pose::modules::fivept_kneip::sPolynomial48( Eigen::Matrix<double,66,197> & groebnerMatrix )
1481 {
1482 groebnerMatrix(48,55) = -groebnerMatrix(37,161)/(groebnerMatrix(37,160));
1483 groebnerMatrix(48,56) = -groebnerMatrix(37,162)/(groebnerMatrix(37,160));
1484 groebnerMatrix(48,80) = groebnerMatrix(11,174)/(groebnerMatrix(11,166));
1485 groebnerMatrix(48,82) = -groebnerMatrix(37,170)/(groebnerMatrix(37,160));
1486 groebnerMatrix(48,83) = -groebnerMatrix(37,171)/(groebnerMatrix(37,160));
1487 groebnerMatrix(48,85) = -groebnerMatrix(37,173)/(groebnerMatrix(37,160));
1488 groebnerMatrix(48,86) = -groebnerMatrix(37,174)/(groebnerMatrix(37,160));
1489 groebnerMatrix(48,88) = -groebnerMatrix(37,176)/(groebnerMatrix(37,160));
1490 groebnerMatrix(48,95) = -groebnerMatrix(37,177)/(groebnerMatrix(37,160));
1491 groebnerMatrix(48,117) = groebnerMatrix(11,183)/(groebnerMatrix(11,166));
1492 groebnerMatrix(48,118) = -groebnerMatrix(37,178)/(groebnerMatrix(37,160));
1493 groebnerMatrix(48,119) = -groebnerMatrix(37,179)/(groebnerMatrix(37,160));
1494 groebnerMatrix(48,120) = -groebnerMatrix(37,180)/(groebnerMatrix(37,160));
1495 groebnerMatrix(48,121) = -groebnerMatrix(37,181)/(groebnerMatrix(37,160));
1496 groebnerMatrix(48,122) = -groebnerMatrix(37,182)/(groebnerMatrix(37,160));
1497 groebnerMatrix(48,123) = -groebnerMatrix(37,183)/(groebnerMatrix(37,160));
1498 groebnerMatrix(48,124) = -groebnerMatrix(37,184)/(groebnerMatrix(37,160));
1499 groebnerMatrix(48,131) = -groebnerMatrix(37,185)/(groebnerMatrix(37,160));
1500 groebnerMatrix(48,139) = -groebnerMatrix(37,186)/(groebnerMatrix(37,160));
1501 groebnerMatrix(48,163) = -groebnerMatrix(37,187)/(groebnerMatrix(37,160));
1502 groebnerMatrix(48,164) = -groebnerMatrix(37,188)/(groebnerMatrix(37,160));
1503 groebnerMatrix(48,165) = -groebnerMatrix(37,189)/(groebnerMatrix(37,160));
1504 groebnerMatrix(48,166) = -groebnerMatrix(37,190)/(groebnerMatrix(37,160));
1505 groebnerMatrix(48,167) = -groebnerMatrix(37,191)/(groebnerMatrix(37,160));
1506 groebnerMatrix(48,168) = -groebnerMatrix(37,192)/(groebnerMatrix(37,160));
1507 groebnerMatrix(48,169) = -groebnerMatrix(37,193)/(groebnerMatrix(37,160));
1508 groebnerMatrix(48,176) = -groebnerMatrix(37,194)/(groebnerMatrix(37,160));
1509 groebnerMatrix(48,184) = -groebnerMatrix(37,195)/(groebnerMatrix(37,160));
1510 groebnerMatrix(48,193) = -groebnerMatrix(37,196)/(groebnerMatrix(37,160));
1511 }
1512
1513 void
sPolynomial49(Eigen::Matrix<double,66,197> & groebnerMatrix)1514 opengv::relative_pose::modules::fivept_kneip::sPolynomial49( Eigen::Matrix<double,66,197> & groebnerMatrix )
1515 {
1516 groebnerMatrix(49,54) = -groebnerMatrix(36,160)/(groebnerMatrix(36,159));
1517 groebnerMatrix(49,55) = -groebnerMatrix(36,161)/(groebnerMatrix(36,159));
1518 groebnerMatrix(49,56) = -groebnerMatrix(36,162)/(groebnerMatrix(36,159));
1519 groebnerMatrix(49,82) = -groebnerMatrix(36,170)/(groebnerMatrix(36,159));
1520 groebnerMatrix(49,83) = -groebnerMatrix(36,171)/(groebnerMatrix(36,159));
1521 groebnerMatrix(49,85) = -groebnerMatrix(36,173)/(groebnerMatrix(36,159));
1522 groebnerMatrix(49,86) = -groebnerMatrix(36,174)/(groebnerMatrix(36,159));
1523 groebnerMatrix(49,88) = -groebnerMatrix(36,176)/(groebnerMatrix(36,159));
1524 groebnerMatrix(49,95) = -groebnerMatrix(36,177)/(groebnerMatrix(36,159));
1525 groebnerMatrix(49,105) = groebnerMatrix(27,181)/(groebnerMatrix(27,168));
1526 groebnerMatrix(49,118) = -groebnerMatrix(36,178)/(groebnerMatrix(36,159));
1527 groebnerMatrix(49,119) = -groebnerMatrix(36,179)/(groebnerMatrix(36,159));
1528 groebnerMatrix(49,120) = -groebnerMatrix(36,180)/(groebnerMatrix(36,159));
1529 groebnerMatrix(49,121) = -groebnerMatrix(36,181)/(groebnerMatrix(36,159));
1530 groebnerMatrix(49,122) = -groebnerMatrix(36,182)/(groebnerMatrix(36,159));
1531 groebnerMatrix(49,123) = -groebnerMatrix(36,183)/(groebnerMatrix(36,159));
1532 groebnerMatrix(49,124) = -groebnerMatrix(36,184)/(groebnerMatrix(36,159));
1533 groebnerMatrix(49,131) = -groebnerMatrix(36,185)/(groebnerMatrix(36,159));
1534 groebnerMatrix(49,139) = -groebnerMatrix(36,186)/(groebnerMatrix(36,159));
1535 groebnerMatrix(49,146) = groebnerMatrix(27,188)/(groebnerMatrix(27,168));
1536 groebnerMatrix(49,163) = -groebnerMatrix(36,187)/(groebnerMatrix(36,159));
1537 groebnerMatrix(49,164) = -groebnerMatrix(36,188)/(groebnerMatrix(36,159));
1538 groebnerMatrix(49,165) = -groebnerMatrix(36,189)/(groebnerMatrix(36,159));
1539 groebnerMatrix(49,166) = -groebnerMatrix(36,190)/(groebnerMatrix(36,159));
1540 groebnerMatrix(49,167) = -groebnerMatrix(36,191)/(groebnerMatrix(36,159));
1541 groebnerMatrix(49,168) = -groebnerMatrix(36,192)/(groebnerMatrix(36,159));
1542 groebnerMatrix(49,169) = -groebnerMatrix(36,193)/(groebnerMatrix(36,159));
1543 groebnerMatrix(49,176) = -groebnerMatrix(36,194)/(groebnerMatrix(36,159));
1544 groebnerMatrix(49,184) = -groebnerMatrix(36,195)/(groebnerMatrix(36,159));
1545 groebnerMatrix(49,193) = -groebnerMatrix(36,196)/(groebnerMatrix(36,159));
1546 }
1547
1548 void
sPolynomial50(Eigen::Matrix<double,66,197> & groebnerMatrix)1549 opengv::relative_pose::modules::fivept_kneip::sPolynomial50( Eigen::Matrix<double,66,197> & groebnerMatrix )
1550 {
1551 groebnerMatrix(50,53) = -groebnerMatrix(35,159)/(groebnerMatrix(35,158));
1552 groebnerMatrix(50,54) = -groebnerMatrix(35,160)/(groebnerMatrix(35,158));
1553 groebnerMatrix(50,55) = -groebnerMatrix(35,161)/(groebnerMatrix(35,158));
1554 groebnerMatrix(50,56) = -groebnerMatrix(35,162)/(groebnerMatrix(35,158));
1555 groebnerMatrix(50,76) = groebnerMatrix(20,170)/(groebnerMatrix(20,164));
1556 groebnerMatrix(50,82) = -groebnerMatrix(35,170)/(groebnerMatrix(35,158));
1557 groebnerMatrix(50,83) = -groebnerMatrix(35,171)/(groebnerMatrix(35,158));
1558 groebnerMatrix(50,85) = -groebnerMatrix(35,173)/(groebnerMatrix(35,158));
1559 groebnerMatrix(50,86) = -groebnerMatrix(35,174)/(groebnerMatrix(35,158));
1560 groebnerMatrix(50,88) = -groebnerMatrix(35,176)/(groebnerMatrix(35,158));
1561 groebnerMatrix(50,95) = -groebnerMatrix(35,177)/(groebnerMatrix(35,158));
1562 groebnerMatrix(50,118) = -groebnerMatrix(35,178)/(groebnerMatrix(35,158));
1563 groebnerMatrix(50,119) = -groebnerMatrix(35,179)/(groebnerMatrix(35,158));
1564 groebnerMatrix(50,120) = -groebnerMatrix(35,180)/(groebnerMatrix(35,158));
1565 groebnerMatrix(50,121) = -groebnerMatrix(35,181)/(groebnerMatrix(35,158));
1566 groebnerMatrix(50,122) = -groebnerMatrix(35,182)/(groebnerMatrix(35,158));
1567 groebnerMatrix(50,123) = -groebnerMatrix(35,183)/(groebnerMatrix(35,158));
1568 groebnerMatrix(50,124) = -groebnerMatrix(35,184)/(groebnerMatrix(35,158));
1569 groebnerMatrix(50,131) = -groebnerMatrix(35,185)/(groebnerMatrix(35,158));
1570 groebnerMatrix(50,139) = -groebnerMatrix(35,186)/(groebnerMatrix(35,158));
1571 groebnerMatrix(50,162) = groebnerMatrix(20,192)/(groebnerMatrix(20,164));
1572 groebnerMatrix(50,163) = -groebnerMatrix(35,187)/(groebnerMatrix(35,158));
1573 groebnerMatrix(50,164) = -groebnerMatrix(35,188)/(groebnerMatrix(35,158));
1574 groebnerMatrix(50,165) = -groebnerMatrix(35,189)/(groebnerMatrix(35,158));
1575 groebnerMatrix(50,166) = -groebnerMatrix(35,190)/(groebnerMatrix(35,158));
1576 groebnerMatrix(50,167) = -groebnerMatrix(35,191)/(groebnerMatrix(35,158));
1577 groebnerMatrix(50,168) = -groebnerMatrix(35,192)/(groebnerMatrix(35,158));
1578 groebnerMatrix(50,169) = -groebnerMatrix(35,193)/(groebnerMatrix(35,158));
1579 groebnerMatrix(50,176) = -groebnerMatrix(35,194)/(groebnerMatrix(35,158));
1580 groebnerMatrix(50,184) = -groebnerMatrix(35,195)/(groebnerMatrix(35,158));
1581 groebnerMatrix(50,193) = -groebnerMatrix(35,196)/(groebnerMatrix(35,158));
1582 }
1583
1584 void
sPolynomial51(Eigen::Matrix<double,66,197> & groebnerMatrix)1585 opengv::relative_pose::modules::fivept_kneip::sPolynomial51( Eigen::Matrix<double,66,197> & groebnerMatrix )
1586 {
1587 groebnerMatrix(51,52) = -groebnerMatrix(34,158)/(groebnerMatrix(34,157));
1588 groebnerMatrix(51,53) = -groebnerMatrix(34,159)/(groebnerMatrix(34,157));
1589 groebnerMatrix(51,54) = -groebnerMatrix(34,160)/(groebnerMatrix(34,157));
1590 groebnerMatrix(51,55) = -groebnerMatrix(34,161)/(groebnerMatrix(34,157));
1591 groebnerMatrix(51,56) = -groebnerMatrix(34,162)/(groebnerMatrix(34,157));
1592 groebnerMatrix(51,77) = groebnerMatrix(12,171)/(groebnerMatrix(12,163));
1593 groebnerMatrix(51,82) = -groebnerMatrix(34,170)/(groebnerMatrix(34,157));
1594 groebnerMatrix(51,83) = -groebnerMatrix(34,171)/(groebnerMatrix(34,157));
1595 groebnerMatrix(51,85) = -groebnerMatrix(34,173)/(groebnerMatrix(34,157));
1596 groebnerMatrix(51,86) = -groebnerMatrix(34,174)/(groebnerMatrix(34,157));
1597 groebnerMatrix(51,88) = -groebnerMatrix(34,176)/(groebnerMatrix(34,157));
1598 groebnerMatrix(51,95) = -groebnerMatrix(34,177)/(groebnerMatrix(34,157));
1599 groebnerMatrix(51,114) = groebnerMatrix(12,180)/(groebnerMatrix(12,163));
1600 groebnerMatrix(51,118) = -groebnerMatrix(34,178)/(groebnerMatrix(34,157));
1601 groebnerMatrix(51,119) = -groebnerMatrix(34,179)/(groebnerMatrix(34,157));
1602 groebnerMatrix(51,120) = -groebnerMatrix(34,180)/(groebnerMatrix(34,157));
1603 groebnerMatrix(51,121) = -groebnerMatrix(34,181)/(groebnerMatrix(34,157));
1604 groebnerMatrix(51,122) = -groebnerMatrix(34,182)/(groebnerMatrix(34,157));
1605 groebnerMatrix(51,123) = -groebnerMatrix(34,183)/(groebnerMatrix(34,157));
1606 groebnerMatrix(51,124) = -groebnerMatrix(34,184)/(groebnerMatrix(34,157));
1607 groebnerMatrix(51,131) = -groebnerMatrix(34,185)/(groebnerMatrix(34,157));
1608 groebnerMatrix(51,139) = -groebnerMatrix(34,186)/(groebnerMatrix(34,157));
1609 groebnerMatrix(51,163) = -groebnerMatrix(34,187)/(groebnerMatrix(34,157));
1610 groebnerMatrix(51,164) = -groebnerMatrix(34,188)/(groebnerMatrix(34,157));
1611 groebnerMatrix(51,165) = -groebnerMatrix(34,189)/(groebnerMatrix(34,157));
1612 groebnerMatrix(51,166) = -groebnerMatrix(34,190)/(groebnerMatrix(34,157));
1613 groebnerMatrix(51,167) = -groebnerMatrix(34,191)/(groebnerMatrix(34,157));
1614 groebnerMatrix(51,168) = -groebnerMatrix(34,192)/(groebnerMatrix(34,157));
1615 groebnerMatrix(51,169) = -groebnerMatrix(34,193)/(groebnerMatrix(34,157));
1616 groebnerMatrix(51,176) = -groebnerMatrix(34,194)/(groebnerMatrix(34,157));
1617 groebnerMatrix(51,184) = -groebnerMatrix(34,195)/(groebnerMatrix(34,157));
1618 groebnerMatrix(51,193) = -groebnerMatrix(34,196)/(groebnerMatrix(34,157));
1619 }
1620
1621 void
sPolynomial52(Eigen::Matrix<double,66,197> & groebnerMatrix)1622 opengv::relative_pose::modules::fivept_kneip::sPolynomial52( Eigen::Matrix<double,66,197> & groebnerMatrix )
1623 {
1624 groebnerMatrix(52,51) = -groebnerMatrix(33,157)/(groebnerMatrix(33,156));
1625 groebnerMatrix(52,52) = -groebnerMatrix(33,158)/(groebnerMatrix(33,156));
1626 groebnerMatrix(52,53) = -groebnerMatrix(33,159)/(groebnerMatrix(33,156));
1627 groebnerMatrix(52,54) = -groebnerMatrix(33,160)/(groebnerMatrix(33,156));
1628 groebnerMatrix(52,55) = -groebnerMatrix(33,161)/(groebnerMatrix(33,156));
1629 groebnerMatrix(52,56) = -groebnerMatrix(33,162)/(groebnerMatrix(33,156));
1630 groebnerMatrix(52,74) = groebnerMatrix(21,173)/(groebnerMatrix(21,167));
1631 groebnerMatrix(52,82) = -groebnerMatrix(33,170)/(groebnerMatrix(33,156));
1632 groebnerMatrix(52,83) = -groebnerMatrix(33,171)/(groebnerMatrix(33,156));
1633 groebnerMatrix(52,85) = -groebnerMatrix(33,173)/(groebnerMatrix(33,156));
1634 groebnerMatrix(52,86) = -groebnerMatrix(33,174)/(groebnerMatrix(33,156));
1635 groebnerMatrix(52,88) = -groebnerMatrix(33,176)/(groebnerMatrix(33,156));
1636 groebnerMatrix(52,95) = -groebnerMatrix(33,177)/(groebnerMatrix(33,156));
1637 groebnerMatrix(52,118) = -groebnerMatrix(33,178)/(groebnerMatrix(33,156));
1638 groebnerMatrix(52,119) = -groebnerMatrix(33,179)/(groebnerMatrix(33,156));
1639 groebnerMatrix(52,120) = -groebnerMatrix(33,180)/(groebnerMatrix(33,156));
1640 groebnerMatrix(52,121) = -groebnerMatrix(33,181)/(groebnerMatrix(33,156));
1641 groebnerMatrix(52,122) = -groebnerMatrix(33,182)/(groebnerMatrix(33,156));
1642 groebnerMatrix(52,123) = -groebnerMatrix(33,183)/(groebnerMatrix(33,156));
1643 groebnerMatrix(52,124) = -groebnerMatrix(33,184)/(groebnerMatrix(33,156));
1644 groebnerMatrix(52,131) = -groebnerMatrix(33,185)/(groebnerMatrix(33,156));
1645 groebnerMatrix(52,139) = -groebnerMatrix(33,186)/(groebnerMatrix(33,156));
1646 groebnerMatrix(52,154) = groebnerMatrix(21,189)/(groebnerMatrix(21,167));
1647 groebnerMatrix(52,163) = -groebnerMatrix(33,187)/(groebnerMatrix(33,156));
1648 groebnerMatrix(52,164) = -groebnerMatrix(33,188)/(groebnerMatrix(33,156));
1649 groebnerMatrix(52,165) = -groebnerMatrix(33,189)/(groebnerMatrix(33,156));
1650 groebnerMatrix(52,166) = -groebnerMatrix(33,190)/(groebnerMatrix(33,156));
1651 groebnerMatrix(52,167) = -groebnerMatrix(33,191)/(groebnerMatrix(33,156));
1652 groebnerMatrix(52,168) = -groebnerMatrix(33,192)/(groebnerMatrix(33,156));
1653 groebnerMatrix(52,169) = -groebnerMatrix(33,193)/(groebnerMatrix(33,156));
1654 groebnerMatrix(52,176) = -groebnerMatrix(33,194)/(groebnerMatrix(33,156));
1655 groebnerMatrix(52,184) = -groebnerMatrix(33,195)/(groebnerMatrix(33,156));
1656 groebnerMatrix(52,193) = -groebnerMatrix(33,196)/(groebnerMatrix(33,156));
1657 }
1658
1659 void
sPolynomial53(Eigen::Matrix<double,66,197> & groebnerMatrix)1660 opengv::relative_pose::modules::fivept_kneip::sPolynomial53( Eigen::Matrix<double,66,197> & groebnerMatrix )
1661 {
1662 groebnerMatrix(53,50) = -groebnerMatrix(32,156)/(groebnerMatrix(32,155));
1663 groebnerMatrix(53,51) = -groebnerMatrix(32,157)/(groebnerMatrix(32,155));
1664 groebnerMatrix(53,52) = -groebnerMatrix(32,158)/(groebnerMatrix(32,155));
1665 groebnerMatrix(53,53) = -groebnerMatrix(32,159)/(groebnerMatrix(32,155));
1666 groebnerMatrix(53,54) = -groebnerMatrix(32,160)/(groebnerMatrix(32,155));
1667 groebnerMatrix(53,55) = -groebnerMatrix(32,161)/(groebnerMatrix(32,155));
1668 groebnerMatrix(53,56) = -groebnerMatrix(32,162)/(groebnerMatrix(32,155));
1669 groebnerMatrix(53,75) = groebnerMatrix(11,174)/(groebnerMatrix(11,166));
1670 groebnerMatrix(53,82) = -groebnerMatrix(32,170)/(groebnerMatrix(32,155));
1671 groebnerMatrix(53,83) = -groebnerMatrix(32,171)/(groebnerMatrix(32,155));
1672 groebnerMatrix(53,85) = -groebnerMatrix(32,173)/(groebnerMatrix(32,155));
1673 groebnerMatrix(53,86) = -groebnerMatrix(32,174)/(groebnerMatrix(32,155));
1674 groebnerMatrix(53,88) = -groebnerMatrix(32,176)/(groebnerMatrix(32,155));
1675 groebnerMatrix(53,95) = -groebnerMatrix(32,177)/(groebnerMatrix(32,155));
1676 groebnerMatrix(53,116) = groebnerMatrix(11,183)/(groebnerMatrix(11,166));
1677 groebnerMatrix(53,118) = -groebnerMatrix(32,178)/(groebnerMatrix(32,155));
1678 groebnerMatrix(53,119) = -groebnerMatrix(32,179)/(groebnerMatrix(32,155));
1679 groebnerMatrix(53,120) = -groebnerMatrix(32,180)/(groebnerMatrix(32,155));
1680 groebnerMatrix(53,121) = -groebnerMatrix(32,181)/(groebnerMatrix(32,155));
1681 groebnerMatrix(53,122) = -groebnerMatrix(32,182)/(groebnerMatrix(32,155));
1682 groebnerMatrix(53,123) = -groebnerMatrix(32,183)/(groebnerMatrix(32,155));
1683 groebnerMatrix(53,124) = -groebnerMatrix(32,184)/(groebnerMatrix(32,155));
1684 groebnerMatrix(53,131) = -groebnerMatrix(32,185)/(groebnerMatrix(32,155));
1685 groebnerMatrix(53,139) = -groebnerMatrix(32,186)/(groebnerMatrix(32,155));
1686 groebnerMatrix(53,163) = -groebnerMatrix(32,187)/(groebnerMatrix(32,155));
1687 groebnerMatrix(53,164) = -groebnerMatrix(32,188)/(groebnerMatrix(32,155));
1688 groebnerMatrix(53,165) = -groebnerMatrix(32,189)/(groebnerMatrix(32,155));
1689 groebnerMatrix(53,166) = -groebnerMatrix(32,190)/(groebnerMatrix(32,155));
1690 groebnerMatrix(53,167) = -groebnerMatrix(32,191)/(groebnerMatrix(32,155));
1691 groebnerMatrix(53,168) = -groebnerMatrix(32,192)/(groebnerMatrix(32,155));
1692 groebnerMatrix(53,169) = -groebnerMatrix(32,193)/(groebnerMatrix(32,155));
1693 groebnerMatrix(53,176) = -groebnerMatrix(32,194)/(groebnerMatrix(32,155));
1694 groebnerMatrix(53,184) = -groebnerMatrix(32,195)/(groebnerMatrix(32,155));
1695 groebnerMatrix(53,193) = -groebnerMatrix(32,196)/(groebnerMatrix(32,155));
1696 }
1697
1698 void
sPolynomial54(Eigen::Matrix<double,66,197> & groebnerMatrix)1699 opengv::relative_pose::modules::fivept_kneip::sPolynomial54( Eigen::Matrix<double,66,197> & groebnerMatrix )
1700 {
1701 groebnerMatrix(54,49) = -groebnerMatrix(31,155)/(groebnerMatrix(31,153));
1702 groebnerMatrix(54,50) = -groebnerMatrix(31,156)/(groebnerMatrix(31,153));
1703 groebnerMatrix(54,51) = -groebnerMatrix(31,157)/(groebnerMatrix(31,153));
1704 groebnerMatrix(54,52) = -groebnerMatrix(31,158)/(groebnerMatrix(31,153));
1705 groebnerMatrix(54,53) = -groebnerMatrix(31,159)/(groebnerMatrix(31,153));
1706 groebnerMatrix(54,54) = -groebnerMatrix(31,160)/(groebnerMatrix(31,153));
1707 groebnerMatrix(54,55) = -groebnerMatrix(31,161)/(groebnerMatrix(31,153));
1708 groebnerMatrix(54,56) = -groebnerMatrix(31,162)/(groebnerMatrix(31,153));
1709 groebnerMatrix(54,71) = groebnerMatrix(20,170)/(groebnerMatrix(20,164));
1710 groebnerMatrix(54,82) = -groebnerMatrix(31,170)/(groebnerMatrix(31,153));
1711 groebnerMatrix(54,83) = -groebnerMatrix(31,171)/(groebnerMatrix(31,153));
1712 groebnerMatrix(54,85) = -groebnerMatrix(31,173)/(groebnerMatrix(31,153));
1713 groebnerMatrix(54,86) = -groebnerMatrix(31,174)/(groebnerMatrix(31,153));
1714 groebnerMatrix(54,88) = -groebnerMatrix(31,176)/(groebnerMatrix(31,153));
1715 groebnerMatrix(54,95) = -groebnerMatrix(31,177)/(groebnerMatrix(31,153));
1716 groebnerMatrix(54,118) = -groebnerMatrix(31,178)/(groebnerMatrix(31,153));
1717 groebnerMatrix(54,119) = -groebnerMatrix(31,179)/(groebnerMatrix(31,153));
1718 groebnerMatrix(54,120) = -groebnerMatrix(31,180)/(groebnerMatrix(31,153));
1719 groebnerMatrix(54,121) = -groebnerMatrix(31,181)/(groebnerMatrix(31,153));
1720 groebnerMatrix(54,122) = -groebnerMatrix(31,182)/(groebnerMatrix(31,153));
1721 groebnerMatrix(54,123) = -groebnerMatrix(31,183)/(groebnerMatrix(31,153));
1722 groebnerMatrix(54,124) = -groebnerMatrix(31,184)/(groebnerMatrix(31,153));
1723 groebnerMatrix(54,131) = -groebnerMatrix(31,185)/(groebnerMatrix(31,153));
1724 groebnerMatrix(54,139) = -groebnerMatrix(31,186)/(groebnerMatrix(31,153));
1725 groebnerMatrix(54,161) = groebnerMatrix(20,192)/(groebnerMatrix(20,164));
1726 groebnerMatrix(54,163) = -groebnerMatrix(31,187)/(groebnerMatrix(31,153));
1727 groebnerMatrix(54,164) = -groebnerMatrix(31,188)/(groebnerMatrix(31,153));
1728 groebnerMatrix(54,165) = -groebnerMatrix(31,189)/(groebnerMatrix(31,153));
1729 groebnerMatrix(54,166) = -groebnerMatrix(31,190)/(groebnerMatrix(31,153));
1730 groebnerMatrix(54,167) = -groebnerMatrix(31,191)/(groebnerMatrix(31,153));
1731 groebnerMatrix(54,168) = -groebnerMatrix(31,192)/(groebnerMatrix(31,153));
1732 groebnerMatrix(54,169) = -groebnerMatrix(31,193)/(groebnerMatrix(31,153));
1733 groebnerMatrix(54,176) = -groebnerMatrix(31,194)/(groebnerMatrix(31,153));
1734 groebnerMatrix(54,184) = -groebnerMatrix(31,195)/(groebnerMatrix(31,153));
1735 groebnerMatrix(54,193) = -groebnerMatrix(31,196)/(groebnerMatrix(31,153));
1736 }
1737
1738 void
sPolynomial55(Eigen::Matrix<double,66,197> & groebnerMatrix)1739 opengv::relative_pose::modules::fivept_kneip::sPolynomial55( Eigen::Matrix<double,66,197> & groebnerMatrix )
1740 {
1741 groebnerMatrix(55,38) = groebnerMatrix(38,162)/(groebnerMatrix(38,161));
1742 groebnerMatrix(55,71) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1743 groebnerMatrix(55,72) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1744 groebnerMatrix(55,74) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1745 groebnerMatrix(55,75) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1746 groebnerMatrix(55,76) = groebnerMatrix(38,170)/(groebnerMatrix(38,161));
1747 groebnerMatrix(55,77) = groebnerMatrix(38,171)/(groebnerMatrix(38,161));
1748 groebnerMatrix(55,79) = groebnerMatrix(38,173)/(groebnerMatrix(38,161));
1749 groebnerMatrix(55,80) = groebnerMatrix(38,174)/(groebnerMatrix(38,161));
1750 groebnerMatrix(55,86) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1751 groebnerMatrix(55,87) = groebnerMatrix(38,176)/(groebnerMatrix(38,161));
1752 groebnerMatrix(55,93) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1753 groebnerMatrix(55,94) = groebnerMatrix(38,177)/(groebnerMatrix(38,161));
1754 groebnerMatrix(55,107) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1755 groebnerMatrix(55,108) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1756 groebnerMatrix(55,109) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1757 groebnerMatrix(55,110) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1758 groebnerMatrix(55,111) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1759 groebnerMatrix(55,112) = groebnerMatrix(38,178)/(groebnerMatrix(38,161));
1760 groebnerMatrix(55,113) = groebnerMatrix(38,179)/(groebnerMatrix(38,161));
1761 groebnerMatrix(55,114) = groebnerMatrix(38,180)/(groebnerMatrix(38,161));
1762 groebnerMatrix(55,115) = groebnerMatrix(38,181)/(groebnerMatrix(38,161));
1763 groebnerMatrix(55,116) = (groebnerMatrix(38,182)/(groebnerMatrix(38,161))-groebnerMatrix(39,183)/(groebnerMatrix(39,162)));
1764 groebnerMatrix(55,117) = groebnerMatrix(38,183)/(groebnerMatrix(38,161));
1765 groebnerMatrix(55,122) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1766 groebnerMatrix(55,123) = groebnerMatrix(38,184)/(groebnerMatrix(38,161));
1767 groebnerMatrix(55,129) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1768 groebnerMatrix(55,130) = groebnerMatrix(38,185)/(groebnerMatrix(38,161));
1769 groebnerMatrix(55,137) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1770 groebnerMatrix(55,138) = groebnerMatrix(38,186)/(groebnerMatrix(38,161));
1771 groebnerMatrix(55,152) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1772 groebnerMatrix(55,153) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1773 groebnerMatrix(55,154) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1774 groebnerMatrix(55,155) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1775 groebnerMatrix(55,156) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1776 groebnerMatrix(55,157) = groebnerMatrix(38,187)/(groebnerMatrix(38,161));
1777 groebnerMatrix(55,158) = groebnerMatrix(38,188)/(groebnerMatrix(38,161));
1778 groebnerMatrix(55,159) = groebnerMatrix(38,189)/(groebnerMatrix(38,161));
1779 groebnerMatrix(55,160) = groebnerMatrix(38,190)/(groebnerMatrix(38,161));
1780 groebnerMatrix(55,161) = (groebnerMatrix(38,191)/(groebnerMatrix(38,161))-groebnerMatrix(39,192)/(groebnerMatrix(39,162)));
1781 groebnerMatrix(55,162) = groebnerMatrix(38,192)/(groebnerMatrix(38,161));
1782 groebnerMatrix(55,167) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1783 groebnerMatrix(55,168) = groebnerMatrix(38,193)/(groebnerMatrix(38,161));
1784 groebnerMatrix(55,174) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1785 groebnerMatrix(55,175) = groebnerMatrix(38,194)/(groebnerMatrix(38,161));
1786 groebnerMatrix(55,182) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1787 groebnerMatrix(55,183) = groebnerMatrix(38,195)/(groebnerMatrix(38,161));
1788 groebnerMatrix(55,191) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1789 groebnerMatrix(55,192) = groebnerMatrix(38,196)/(groebnerMatrix(38,161));
1790 }
1791
1792 void
sPolynomial56(Eigen::Matrix<double,66,197> & groebnerMatrix)1793 opengv::relative_pose::modules::fivept_kneip::sPolynomial56( Eigen::Matrix<double,66,197> & groebnerMatrix )
1794 {
1795 groebnerMatrix(56,37) = groebnerMatrix(37,161)/(groebnerMatrix(37,160));
1796 groebnerMatrix(56,38) = groebnerMatrix(37,162)/(groebnerMatrix(37,160));
1797 groebnerMatrix(56,67) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1798 groebnerMatrix(56,68) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1799 groebnerMatrix(56,70) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1800 groebnerMatrix(56,74) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1801 groebnerMatrix(56,76) = groebnerMatrix(37,170)/(groebnerMatrix(37,160));
1802 groebnerMatrix(56,77) = groebnerMatrix(37,171)/(groebnerMatrix(37,160));
1803 groebnerMatrix(56,79) = groebnerMatrix(37,173)/(groebnerMatrix(37,160));
1804 groebnerMatrix(56,80) = groebnerMatrix(37,174)/(groebnerMatrix(37,160));
1805 groebnerMatrix(56,85) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1806 groebnerMatrix(56,87) = groebnerMatrix(37,176)/(groebnerMatrix(37,160));
1807 groebnerMatrix(56,92) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1808 groebnerMatrix(56,94) = groebnerMatrix(37,177)/(groebnerMatrix(37,160));
1809 groebnerMatrix(56,103) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1810 groebnerMatrix(56,104) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1811 groebnerMatrix(56,105) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1812 groebnerMatrix(56,106) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1813 groebnerMatrix(56,110) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1814 groebnerMatrix(56,112) = groebnerMatrix(37,178)/(groebnerMatrix(37,160));
1815 groebnerMatrix(56,113) = groebnerMatrix(37,179)/(groebnerMatrix(37,160));
1816 groebnerMatrix(56,114) = groebnerMatrix(37,180)/(groebnerMatrix(37,160));
1817 groebnerMatrix(56,115) = (groebnerMatrix(37,181)/(groebnerMatrix(37,160))-groebnerMatrix(39,183)/(groebnerMatrix(39,162)));
1818 groebnerMatrix(56,116) = groebnerMatrix(37,182)/(groebnerMatrix(37,160));
1819 groebnerMatrix(56,117) = groebnerMatrix(37,183)/(groebnerMatrix(37,160));
1820 groebnerMatrix(56,121) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1821 groebnerMatrix(56,123) = groebnerMatrix(37,184)/(groebnerMatrix(37,160));
1822 groebnerMatrix(56,128) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1823 groebnerMatrix(56,130) = groebnerMatrix(37,185)/(groebnerMatrix(37,160));
1824 groebnerMatrix(56,136) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1825 groebnerMatrix(56,138) = groebnerMatrix(37,186)/(groebnerMatrix(37,160));
1826 groebnerMatrix(56,148) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1827 groebnerMatrix(56,149) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1828 groebnerMatrix(56,150) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1829 groebnerMatrix(56,151) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1830 groebnerMatrix(56,155) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1831 groebnerMatrix(56,157) = groebnerMatrix(37,187)/(groebnerMatrix(37,160));
1832 groebnerMatrix(56,158) = groebnerMatrix(37,188)/(groebnerMatrix(37,160));
1833 groebnerMatrix(56,159) = groebnerMatrix(37,189)/(groebnerMatrix(37,160));
1834 groebnerMatrix(56,160) = (groebnerMatrix(37,190)/(groebnerMatrix(37,160))-groebnerMatrix(39,192)/(groebnerMatrix(39,162)));
1835 groebnerMatrix(56,161) = groebnerMatrix(37,191)/(groebnerMatrix(37,160));
1836 groebnerMatrix(56,162) = groebnerMatrix(37,192)/(groebnerMatrix(37,160));
1837 groebnerMatrix(56,166) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1838 groebnerMatrix(56,168) = groebnerMatrix(37,193)/(groebnerMatrix(37,160));
1839 groebnerMatrix(56,173) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1840 groebnerMatrix(56,175) = groebnerMatrix(37,194)/(groebnerMatrix(37,160));
1841 groebnerMatrix(56,181) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1842 groebnerMatrix(56,183) = groebnerMatrix(37,195)/(groebnerMatrix(37,160));
1843 groebnerMatrix(56,190) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1844 groebnerMatrix(56,192) = groebnerMatrix(37,196)/(groebnerMatrix(37,160));
1845 }
1846
1847 void
sPolynomial57(Eigen::Matrix<double,66,197> & groebnerMatrix)1848 opengv::relative_pose::modules::fivept_kneip::sPolynomial57( Eigen::Matrix<double,66,197> & groebnerMatrix )
1849 {
1850 groebnerMatrix(57,36) = groebnerMatrix(36,160)/(groebnerMatrix(36,159));
1851 groebnerMatrix(57,37) = groebnerMatrix(36,161)/(groebnerMatrix(36,159));
1852 groebnerMatrix(57,38) = groebnerMatrix(36,162)/(groebnerMatrix(36,159));
1853 groebnerMatrix(57,64) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1854 groebnerMatrix(57,65) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1855 groebnerMatrix(57,69) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1856 groebnerMatrix(57,73) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1857 groebnerMatrix(57,76) = groebnerMatrix(36,170)/(groebnerMatrix(36,159));
1858 groebnerMatrix(57,77) = groebnerMatrix(36,171)/(groebnerMatrix(36,159));
1859 groebnerMatrix(57,79) = groebnerMatrix(36,173)/(groebnerMatrix(36,159));
1860 groebnerMatrix(57,80) = groebnerMatrix(36,174)/(groebnerMatrix(36,159));
1861 groebnerMatrix(57,84) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1862 groebnerMatrix(57,87) = groebnerMatrix(36,176)/(groebnerMatrix(36,159));
1863 groebnerMatrix(57,91) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1864 groebnerMatrix(57,94) = groebnerMatrix(36,177)/(groebnerMatrix(36,159));
1865 groebnerMatrix(57,100) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1866 groebnerMatrix(57,101) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1867 groebnerMatrix(57,102) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1868 groebnerMatrix(57,105) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1869 groebnerMatrix(57,109) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1870 groebnerMatrix(57,112) = groebnerMatrix(36,178)/(groebnerMatrix(36,159));
1871 groebnerMatrix(57,113) = groebnerMatrix(36,179)/(groebnerMatrix(36,159));
1872 groebnerMatrix(57,114) = (groebnerMatrix(36,180)/(groebnerMatrix(36,159))-groebnerMatrix(39,183)/(groebnerMatrix(39,162)));
1873 groebnerMatrix(57,115) = groebnerMatrix(36,181)/(groebnerMatrix(36,159));
1874 groebnerMatrix(57,116) = groebnerMatrix(36,182)/(groebnerMatrix(36,159));
1875 groebnerMatrix(57,117) = groebnerMatrix(36,183)/(groebnerMatrix(36,159));
1876 groebnerMatrix(57,120) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1877 groebnerMatrix(57,123) = groebnerMatrix(36,184)/(groebnerMatrix(36,159));
1878 groebnerMatrix(57,127) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1879 groebnerMatrix(57,130) = groebnerMatrix(36,185)/(groebnerMatrix(36,159));
1880 groebnerMatrix(57,135) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1881 groebnerMatrix(57,138) = groebnerMatrix(36,186)/(groebnerMatrix(36,159));
1882 groebnerMatrix(57,145) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1883 groebnerMatrix(57,146) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1884 groebnerMatrix(57,147) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1885 groebnerMatrix(57,150) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1886 groebnerMatrix(57,154) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1887 groebnerMatrix(57,157) = groebnerMatrix(36,187)/(groebnerMatrix(36,159));
1888 groebnerMatrix(57,158) = groebnerMatrix(36,188)/(groebnerMatrix(36,159));
1889 groebnerMatrix(57,159) = (groebnerMatrix(36,189)/(groebnerMatrix(36,159))-groebnerMatrix(39,192)/(groebnerMatrix(39,162)));
1890 groebnerMatrix(57,160) = groebnerMatrix(36,190)/(groebnerMatrix(36,159));
1891 groebnerMatrix(57,161) = groebnerMatrix(36,191)/(groebnerMatrix(36,159));
1892 groebnerMatrix(57,162) = groebnerMatrix(36,192)/(groebnerMatrix(36,159));
1893 groebnerMatrix(57,165) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1894 groebnerMatrix(57,168) = groebnerMatrix(36,193)/(groebnerMatrix(36,159));
1895 groebnerMatrix(57,172) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1896 groebnerMatrix(57,175) = groebnerMatrix(36,194)/(groebnerMatrix(36,159));
1897 groebnerMatrix(57,180) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1898 groebnerMatrix(57,183) = groebnerMatrix(36,195)/(groebnerMatrix(36,159));
1899 groebnerMatrix(57,189) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1900 groebnerMatrix(57,192) = groebnerMatrix(36,196)/(groebnerMatrix(36,159));
1901 }
1902
1903 void
sPolynomial58(Eigen::Matrix<double,66,197> & groebnerMatrix)1904 opengv::relative_pose::modules::fivept_kneip::sPolynomial58( Eigen::Matrix<double,66,197> & groebnerMatrix )
1905 {
1906 groebnerMatrix(58,35) = groebnerMatrix(35,159)/(groebnerMatrix(35,158));
1907 groebnerMatrix(58,36) = groebnerMatrix(35,160)/(groebnerMatrix(35,158));
1908 groebnerMatrix(58,37) = groebnerMatrix(35,161)/(groebnerMatrix(35,158));
1909 groebnerMatrix(58,38) = groebnerMatrix(35,162)/(groebnerMatrix(35,158));
1910 groebnerMatrix(58,62) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1911 groebnerMatrix(58,63) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1912 groebnerMatrix(58,68) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1913 groebnerMatrix(58,72) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1914 groebnerMatrix(58,76) = groebnerMatrix(35,170)/(groebnerMatrix(35,158));
1915 groebnerMatrix(58,77) = groebnerMatrix(35,171)/(groebnerMatrix(35,158));
1916 groebnerMatrix(58,79) = groebnerMatrix(35,173)/(groebnerMatrix(35,158));
1917 groebnerMatrix(58,80) = groebnerMatrix(35,174)/(groebnerMatrix(35,158));
1918 groebnerMatrix(58,83) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1919 groebnerMatrix(58,87) = groebnerMatrix(35,176)/(groebnerMatrix(35,158));
1920 groebnerMatrix(58,90) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1921 groebnerMatrix(58,94) = groebnerMatrix(35,177)/(groebnerMatrix(35,158));
1922 groebnerMatrix(58,98) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1923 groebnerMatrix(58,99) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1924 groebnerMatrix(58,101) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1925 groebnerMatrix(58,104) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1926 groebnerMatrix(58,108) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1927 groebnerMatrix(58,112) = groebnerMatrix(35,178)/(groebnerMatrix(35,158));
1928 groebnerMatrix(58,113) = (groebnerMatrix(35,179)/(groebnerMatrix(35,158))-groebnerMatrix(39,183)/(groebnerMatrix(39,162)));
1929 groebnerMatrix(58,114) = groebnerMatrix(35,180)/(groebnerMatrix(35,158));
1930 groebnerMatrix(58,115) = groebnerMatrix(35,181)/(groebnerMatrix(35,158));
1931 groebnerMatrix(58,116) = groebnerMatrix(35,182)/(groebnerMatrix(35,158));
1932 groebnerMatrix(58,117) = groebnerMatrix(35,183)/(groebnerMatrix(35,158));
1933 groebnerMatrix(58,119) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1934 groebnerMatrix(58,123) = groebnerMatrix(35,184)/(groebnerMatrix(35,158));
1935 groebnerMatrix(58,126) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1936 groebnerMatrix(58,130) = groebnerMatrix(35,185)/(groebnerMatrix(35,158));
1937 groebnerMatrix(58,134) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1938 groebnerMatrix(58,138) = groebnerMatrix(35,186)/(groebnerMatrix(35,158));
1939 groebnerMatrix(58,143) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1940 groebnerMatrix(58,144) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1941 groebnerMatrix(58,146) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
1942 groebnerMatrix(58,149) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
1943 groebnerMatrix(58,153) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
1944 groebnerMatrix(58,157) = groebnerMatrix(35,187)/(groebnerMatrix(35,158));
1945 groebnerMatrix(58,158) = (groebnerMatrix(35,188)/(groebnerMatrix(35,158))-groebnerMatrix(39,192)/(groebnerMatrix(39,162)));
1946 groebnerMatrix(58,159) = groebnerMatrix(35,189)/(groebnerMatrix(35,158));
1947 groebnerMatrix(58,160) = groebnerMatrix(35,190)/(groebnerMatrix(35,158));
1948 groebnerMatrix(58,161) = groebnerMatrix(35,191)/(groebnerMatrix(35,158));
1949 groebnerMatrix(58,162) = groebnerMatrix(35,192)/(groebnerMatrix(35,158));
1950 groebnerMatrix(58,164) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
1951 groebnerMatrix(58,168) = groebnerMatrix(35,193)/(groebnerMatrix(35,158));
1952 groebnerMatrix(58,171) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
1953 groebnerMatrix(58,175) = groebnerMatrix(35,194)/(groebnerMatrix(35,158));
1954 groebnerMatrix(58,179) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
1955 groebnerMatrix(58,183) = groebnerMatrix(35,195)/(groebnerMatrix(35,158));
1956 groebnerMatrix(58,188) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
1957 groebnerMatrix(58,192) = groebnerMatrix(35,196)/(groebnerMatrix(35,158));
1958 }
1959
1960 void
sPolynomial59(Eigen::Matrix<double,66,197> & groebnerMatrix)1961 opengv::relative_pose::modules::fivept_kneip::sPolynomial59( Eigen::Matrix<double,66,197> & groebnerMatrix )
1962 {
1963 groebnerMatrix(59,34) = groebnerMatrix(34,158)/(groebnerMatrix(34,157));
1964 groebnerMatrix(59,35) = groebnerMatrix(34,159)/(groebnerMatrix(34,157));
1965 groebnerMatrix(59,36) = groebnerMatrix(34,160)/(groebnerMatrix(34,157));
1966 groebnerMatrix(59,37) = groebnerMatrix(34,161)/(groebnerMatrix(34,157));
1967 groebnerMatrix(59,38) = groebnerMatrix(34,162)/(groebnerMatrix(34,157));
1968 groebnerMatrix(59,61) = -groebnerMatrix(39,170)/(groebnerMatrix(39,162));
1969 groebnerMatrix(59,62) = -groebnerMatrix(39,171)/(groebnerMatrix(39,162));
1970 groebnerMatrix(59,67) = -groebnerMatrix(39,173)/(groebnerMatrix(39,162));
1971 groebnerMatrix(59,71) = -groebnerMatrix(39,174)/(groebnerMatrix(39,162));
1972 groebnerMatrix(59,76) = groebnerMatrix(34,170)/(groebnerMatrix(34,157));
1973 groebnerMatrix(59,77) = groebnerMatrix(34,171)/(groebnerMatrix(34,157));
1974 groebnerMatrix(59,79) = groebnerMatrix(34,173)/(groebnerMatrix(34,157));
1975 groebnerMatrix(59,80) = groebnerMatrix(34,174)/(groebnerMatrix(34,157));
1976 groebnerMatrix(59,82) = -groebnerMatrix(39,176)/(groebnerMatrix(39,162));
1977 groebnerMatrix(59,87) = groebnerMatrix(34,176)/(groebnerMatrix(34,157));
1978 groebnerMatrix(59,89) = -groebnerMatrix(39,177)/(groebnerMatrix(39,162));
1979 groebnerMatrix(59,94) = groebnerMatrix(34,177)/(groebnerMatrix(34,157));
1980 groebnerMatrix(59,97) = -groebnerMatrix(39,178)/(groebnerMatrix(39,162));
1981 groebnerMatrix(59,98) = -groebnerMatrix(39,179)/(groebnerMatrix(39,162));
1982 groebnerMatrix(59,100) = -groebnerMatrix(39,180)/(groebnerMatrix(39,162));
1983 groebnerMatrix(59,103) = -groebnerMatrix(39,181)/(groebnerMatrix(39,162));
1984 groebnerMatrix(59,107) = -groebnerMatrix(39,182)/(groebnerMatrix(39,162));
1985 groebnerMatrix(59,112) = (groebnerMatrix(34,178)/(groebnerMatrix(34,157))-groebnerMatrix(39,183)/(groebnerMatrix(39,162)));
1986 groebnerMatrix(59,113) = groebnerMatrix(34,179)/(groebnerMatrix(34,157));
1987 groebnerMatrix(59,114) = groebnerMatrix(34,180)/(groebnerMatrix(34,157));
1988 groebnerMatrix(59,115) = groebnerMatrix(34,181)/(groebnerMatrix(34,157));
1989 groebnerMatrix(59,116) = groebnerMatrix(34,182)/(groebnerMatrix(34,157));
1990 groebnerMatrix(59,117) = groebnerMatrix(34,183)/(groebnerMatrix(34,157));
1991 groebnerMatrix(59,118) = -groebnerMatrix(39,184)/(groebnerMatrix(39,162));
1992 groebnerMatrix(59,123) = groebnerMatrix(34,184)/(groebnerMatrix(34,157));
1993 groebnerMatrix(59,125) = -groebnerMatrix(39,185)/(groebnerMatrix(39,162));
1994 groebnerMatrix(59,130) = groebnerMatrix(34,185)/(groebnerMatrix(34,157));
1995 groebnerMatrix(59,133) = -groebnerMatrix(39,186)/(groebnerMatrix(39,162));
1996 groebnerMatrix(59,138) = groebnerMatrix(34,186)/(groebnerMatrix(34,157));
1997 groebnerMatrix(59,142) = -groebnerMatrix(39,187)/(groebnerMatrix(39,162));
1998 groebnerMatrix(59,143) = -groebnerMatrix(39,188)/(groebnerMatrix(39,162));
1999 groebnerMatrix(59,145) = -groebnerMatrix(39,189)/(groebnerMatrix(39,162));
2000 groebnerMatrix(59,148) = -groebnerMatrix(39,190)/(groebnerMatrix(39,162));
2001 groebnerMatrix(59,152) = -groebnerMatrix(39,191)/(groebnerMatrix(39,162));
2002 groebnerMatrix(59,157) = (groebnerMatrix(34,187)/(groebnerMatrix(34,157))-groebnerMatrix(39,192)/(groebnerMatrix(39,162)));
2003 groebnerMatrix(59,158) = groebnerMatrix(34,188)/(groebnerMatrix(34,157));
2004 groebnerMatrix(59,159) = groebnerMatrix(34,189)/(groebnerMatrix(34,157));
2005 groebnerMatrix(59,160) = groebnerMatrix(34,190)/(groebnerMatrix(34,157));
2006 groebnerMatrix(59,161) = groebnerMatrix(34,191)/(groebnerMatrix(34,157));
2007 groebnerMatrix(59,162) = groebnerMatrix(34,192)/(groebnerMatrix(34,157));
2008 groebnerMatrix(59,163) = -groebnerMatrix(39,193)/(groebnerMatrix(39,162));
2009 groebnerMatrix(59,168) = groebnerMatrix(34,193)/(groebnerMatrix(34,157));
2010 groebnerMatrix(59,170) = -groebnerMatrix(39,194)/(groebnerMatrix(39,162));
2011 groebnerMatrix(59,175) = groebnerMatrix(34,194)/(groebnerMatrix(34,157));
2012 groebnerMatrix(59,178) = -groebnerMatrix(39,195)/(groebnerMatrix(39,162));
2013 groebnerMatrix(59,183) = groebnerMatrix(34,195)/(groebnerMatrix(34,157));
2014 groebnerMatrix(59,187) = -groebnerMatrix(39,196)/(groebnerMatrix(39,162));
2015 groebnerMatrix(59,192) = groebnerMatrix(34,196)/(groebnerMatrix(34,157));
2016 }
2017
2018 void
sPolynomial60(Eigen::Matrix<double,66,197> & groebnerMatrix)2019 opengv::relative_pose::modules::fivept_kneip::sPolynomial60( Eigen::Matrix<double,66,197> & groebnerMatrix )
2020 {
2021 groebnerMatrix(60,33) = groebnerMatrix(33,157)/(groebnerMatrix(33,156));
2022 groebnerMatrix(60,34) = groebnerMatrix(33,158)/(groebnerMatrix(33,156));
2023 groebnerMatrix(60,35) = groebnerMatrix(33,159)/(groebnerMatrix(33,156));
2024 groebnerMatrix(60,36) = groebnerMatrix(33,160)/(groebnerMatrix(33,156));
2025 groebnerMatrix(60,37) = (groebnerMatrix(33,161)/(groebnerMatrix(33,156))-groebnerMatrix(38,162)/(groebnerMatrix(38,161)));
2026 groebnerMatrix(60,38) = groebnerMatrix(33,162)/(groebnerMatrix(33,156));
2027 groebnerMatrix(60,71) = -groebnerMatrix(38,170)/(groebnerMatrix(38,161));
2028 groebnerMatrix(60,72) = -groebnerMatrix(38,171)/(groebnerMatrix(38,161));
2029 groebnerMatrix(60,74) = -groebnerMatrix(38,173)/(groebnerMatrix(38,161));
2030 groebnerMatrix(60,75) = -groebnerMatrix(38,174)/(groebnerMatrix(38,161));
2031 groebnerMatrix(60,76) = groebnerMatrix(33,170)/(groebnerMatrix(33,156));
2032 groebnerMatrix(60,77) = groebnerMatrix(33,171)/(groebnerMatrix(33,156));
2033 groebnerMatrix(60,79) = groebnerMatrix(33,173)/(groebnerMatrix(33,156));
2034 groebnerMatrix(60,80) = groebnerMatrix(33,174)/(groebnerMatrix(33,156));
2035 groebnerMatrix(60,86) = -groebnerMatrix(38,176)/(groebnerMatrix(38,161));
2036 groebnerMatrix(60,87) = groebnerMatrix(33,176)/(groebnerMatrix(33,156));
2037 groebnerMatrix(60,93) = -groebnerMatrix(38,177)/(groebnerMatrix(38,161));
2038 groebnerMatrix(60,94) = groebnerMatrix(33,177)/(groebnerMatrix(33,156));
2039 groebnerMatrix(60,107) = -groebnerMatrix(38,178)/(groebnerMatrix(38,161));
2040 groebnerMatrix(60,108) = -groebnerMatrix(38,179)/(groebnerMatrix(38,161));
2041 groebnerMatrix(60,109) = -groebnerMatrix(38,180)/(groebnerMatrix(38,161));
2042 groebnerMatrix(60,110) = -groebnerMatrix(38,181)/(groebnerMatrix(38,161));
2043 groebnerMatrix(60,111) = -groebnerMatrix(38,182)/(groebnerMatrix(38,161));
2044 groebnerMatrix(60,112) = groebnerMatrix(33,178)/(groebnerMatrix(33,156));
2045 groebnerMatrix(60,113) = groebnerMatrix(33,179)/(groebnerMatrix(33,156));
2046 groebnerMatrix(60,114) = groebnerMatrix(33,180)/(groebnerMatrix(33,156));
2047 groebnerMatrix(60,115) = groebnerMatrix(33,181)/(groebnerMatrix(33,156));
2048 groebnerMatrix(60,116) = (groebnerMatrix(33,182)/(groebnerMatrix(33,156))-groebnerMatrix(38,183)/(groebnerMatrix(38,161)));
2049 groebnerMatrix(60,117) = groebnerMatrix(33,183)/(groebnerMatrix(33,156));
2050 groebnerMatrix(60,122) = -groebnerMatrix(38,184)/(groebnerMatrix(38,161));
2051 groebnerMatrix(60,123) = groebnerMatrix(33,184)/(groebnerMatrix(33,156));
2052 groebnerMatrix(60,129) = -groebnerMatrix(38,185)/(groebnerMatrix(38,161));
2053 groebnerMatrix(60,130) = groebnerMatrix(33,185)/(groebnerMatrix(33,156));
2054 groebnerMatrix(60,137) = -groebnerMatrix(38,186)/(groebnerMatrix(38,161));
2055 groebnerMatrix(60,138) = groebnerMatrix(33,186)/(groebnerMatrix(33,156));
2056 groebnerMatrix(60,152) = -groebnerMatrix(38,187)/(groebnerMatrix(38,161));
2057 groebnerMatrix(60,153) = -groebnerMatrix(38,188)/(groebnerMatrix(38,161));
2058 groebnerMatrix(60,154) = -groebnerMatrix(38,189)/(groebnerMatrix(38,161));
2059 groebnerMatrix(60,155) = -groebnerMatrix(38,190)/(groebnerMatrix(38,161));
2060 groebnerMatrix(60,156) = -groebnerMatrix(38,191)/(groebnerMatrix(38,161));
2061 groebnerMatrix(60,157) = groebnerMatrix(33,187)/(groebnerMatrix(33,156));
2062 groebnerMatrix(60,158) = groebnerMatrix(33,188)/(groebnerMatrix(33,156));
2063 groebnerMatrix(60,159) = groebnerMatrix(33,189)/(groebnerMatrix(33,156));
2064 groebnerMatrix(60,160) = groebnerMatrix(33,190)/(groebnerMatrix(33,156));
2065 groebnerMatrix(60,161) = (groebnerMatrix(33,191)/(groebnerMatrix(33,156))-groebnerMatrix(38,192)/(groebnerMatrix(38,161)));
2066 groebnerMatrix(60,162) = groebnerMatrix(33,192)/(groebnerMatrix(33,156));
2067 groebnerMatrix(60,167) = -groebnerMatrix(38,193)/(groebnerMatrix(38,161));
2068 groebnerMatrix(60,168) = groebnerMatrix(33,193)/(groebnerMatrix(33,156));
2069 groebnerMatrix(60,174) = -groebnerMatrix(38,194)/(groebnerMatrix(38,161));
2070 groebnerMatrix(60,175) = groebnerMatrix(33,194)/(groebnerMatrix(33,156));
2071 groebnerMatrix(60,182) = -groebnerMatrix(38,195)/(groebnerMatrix(38,161));
2072 groebnerMatrix(60,183) = groebnerMatrix(33,195)/(groebnerMatrix(33,156));
2073 groebnerMatrix(60,191) = -groebnerMatrix(38,196)/(groebnerMatrix(38,161));
2074 groebnerMatrix(60,192) = groebnerMatrix(33,196)/(groebnerMatrix(33,156));
2075 }
2076
2077 void
sPolynomial61(Eigen::Matrix<double,66,197> & groebnerMatrix)2078 opengv::relative_pose::modules::fivept_kneip::sPolynomial61( Eigen::Matrix<double,66,197> & groebnerMatrix )
2079 {
2080 groebnerMatrix(61,32) = (groebnerMatrix(32,156)/(groebnerMatrix(32,155))-groebnerMatrix(37,161)/(groebnerMatrix(37,160)));
2081 groebnerMatrix(61,33) = groebnerMatrix(32,157)/(groebnerMatrix(32,155));
2082 groebnerMatrix(61,34) = groebnerMatrix(32,158)/(groebnerMatrix(32,155));
2083 groebnerMatrix(61,35) = groebnerMatrix(32,159)/(groebnerMatrix(32,155));
2084 groebnerMatrix(61,36) = groebnerMatrix(32,160)/(groebnerMatrix(32,155));
2085 groebnerMatrix(61,37) = (groebnerMatrix(32,161)/(groebnerMatrix(32,155))-groebnerMatrix(37,162)/(groebnerMatrix(37,160)));
2086 groebnerMatrix(61,38) = groebnerMatrix(32,162)/(groebnerMatrix(32,155));
2087 groebnerMatrix(61,71) = -groebnerMatrix(37,170)/(groebnerMatrix(37,160));
2088 groebnerMatrix(61,72) = -groebnerMatrix(37,171)/(groebnerMatrix(37,160));
2089 groebnerMatrix(61,74) = -groebnerMatrix(37,173)/(groebnerMatrix(37,160));
2090 groebnerMatrix(61,75) = -groebnerMatrix(37,174)/(groebnerMatrix(37,160));
2091 groebnerMatrix(61,76) = groebnerMatrix(32,170)/(groebnerMatrix(32,155));
2092 groebnerMatrix(61,77) = groebnerMatrix(32,171)/(groebnerMatrix(32,155));
2093 groebnerMatrix(61,79) = groebnerMatrix(32,173)/(groebnerMatrix(32,155));
2094 groebnerMatrix(61,80) = groebnerMatrix(32,174)/(groebnerMatrix(32,155));
2095 groebnerMatrix(61,86) = -groebnerMatrix(37,176)/(groebnerMatrix(37,160));
2096 groebnerMatrix(61,87) = groebnerMatrix(32,176)/(groebnerMatrix(32,155));
2097 groebnerMatrix(61,93) = -groebnerMatrix(37,177)/(groebnerMatrix(37,160));
2098 groebnerMatrix(61,94) = groebnerMatrix(32,177)/(groebnerMatrix(32,155));
2099 groebnerMatrix(61,107) = -groebnerMatrix(37,178)/(groebnerMatrix(37,160));
2100 groebnerMatrix(61,108) = -groebnerMatrix(37,179)/(groebnerMatrix(37,160));
2101 groebnerMatrix(61,109) = -groebnerMatrix(37,180)/(groebnerMatrix(37,160));
2102 groebnerMatrix(61,110) = -groebnerMatrix(37,181)/(groebnerMatrix(37,160));
2103 groebnerMatrix(61,111) = -groebnerMatrix(37,182)/(groebnerMatrix(37,160));
2104 groebnerMatrix(61,112) = groebnerMatrix(32,178)/(groebnerMatrix(32,155));
2105 groebnerMatrix(61,113) = groebnerMatrix(32,179)/(groebnerMatrix(32,155));
2106 groebnerMatrix(61,114) = groebnerMatrix(32,180)/(groebnerMatrix(32,155));
2107 groebnerMatrix(61,115) = groebnerMatrix(32,181)/(groebnerMatrix(32,155));
2108 groebnerMatrix(61,116) = (groebnerMatrix(32,182)/(groebnerMatrix(32,155))-groebnerMatrix(37,183)/(groebnerMatrix(37,160)));
2109 groebnerMatrix(61,117) = groebnerMatrix(32,183)/(groebnerMatrix(32,155));
2110 groebnerMatrix(61,122) = -groebnerMatrix(37,184)/(groebnerMatrix(37,160));
2111 groebnerMatrix(61,123) = groebnerMatrix(32,184)/(groebnerMatrix(32,155));
2112 groebnerMatrix(61,129) = -groebnerMatrix(37,185)/(groebnerMatrix(37,160));
2113 groebnerMatrix(61,130) = groebnerMatrix(32,185)/(groebnerMatrix(32,155));
2114 groebnerMatrix(61,137) = -groebnerMatrix(37,186)/(groebnerMatrix(37,160));
2115 groebnerMatrix(61,138) = groebnerMatrix(32,186)/(groebnerMatrix(32,155));
2116 groebnerMatrix(61,152) = -groebnerMatrix(37,187)/(groebnerMatrix(37,160));
2117 groebnerMatrix(61,153) = -groebnerMatrix(37,188)/(groebnerMatrix(37,160));
2118 groebnerMatrix(61,154) = -groebnerMatrix(37,189)/(groebnerMatrix(37,160));
2119 groebnerMatrix(61,155) = -groebnerMatrix(37,190)/(groebnerMatrix(37,160));
2120 groebnerMatrix(61,156) = -groebnerMatrix(37,191)/(groebnerMatrix(37,160));
2121 groebnerMatrix(61,157) = groebnerMatrix(32,187)/(groebnerMatrix(32,155));
2122 groebnerMatrix(61,158) = groebnerMatrix(32,188)/(groebnerMatrix(32,155));
2123 groebnerMatrix(61,159) = groebnerMatrix(32,189)/(groebnerMatrix(32,155));
2124 groebnerMatrix(61,160) = groebnerMatrix(32,190)/(groebnerMatrix(32,155));
2125 groebnerMatrix(61,161) = (groebnerMatrix(32,191)/(groebnerMatrix(32,155))-groebnerMatrix(37,192)/(groebnerMatrix(37,160)));
2126 groebnerMatrix(61,162) = groebnerMatrix(32,192)/(groebnerMatrix(32,155));
2127 groebnerMatrix(61,167) = -groebnerMatrix(37,193)/(groebnerMatrix(37,160));
2128 groebnerMatrix(61,168) = groebnerMatrix(32,193)/(groebnerMatrix(32,155));
2129 groebnerMatrix(61,174) = -groebnerMatrix(37,194)/(groebnerMatrix(37,160));
2130 groebnerMatrix(61,175) = groebnerMatrix(32,194)/(groebnerMatrix(32,155));
2131 groebnerMatrix(61,182) = -groebnerMatrix(37,195)/(groebnerMatrix(37,160));
2132 groebnerMatrix(61,183) = groebnerMatrix(32,195)/(groebnerMatrix(32,155));
2133 groebnerMatrix(61,191) = -groebnerMatrix(37,196)/(groebnerMatrix(37,160));
2134 groebnerMatrix(61,192) = groebnerMatrix(32,196)/(groebnerMatrix(32,155));
2135 }
2136
2137 void
sPolynomial62(Eigen::Matrix<double,66,197> & groebnerMatrix)2138 opengv::relative_pose::modules::fivept_kneip::sPolynomial62( Eigen::Matrix<double,66,197> & groebnerMatrix )
2139 {
2140 groebnerMatrix(62,32) = groebnerMatrix(32,156)/(groebnerMatrix(32,155));
2141 groebnerMatrix(62,33) = groebnerMatrix(32,157)/(groebnerMatrix(32,155));
2142 groebnerMatrix(62,34) = groebnerMatrix(32,158)/(groebnerMatrix(32,155));
2143 groebnerMatrix(62,35) = groebnerMatrix(32,159)/(groebnerMatrix(32,155));
2144 groebnerMatrix(62,36) = (groebnerMatrix(32,160)/(groebnerMatrix(32,155))-groebnerMatrix(38,162)/(groebnerMatrix(38,161)));
2145 groebnerMatrix(62,37) = groebnerMatrix(32,161)/(groebnerMatrix(32,155));
2146 groebnerMatrix(62,38) = groebnerMatrix(32,162)/(groebnerMatrix(32,155));
2147 groebnerMatrix(62,67) = -groebnerMatrix(38,170)/(groebnerMatrix(38,161));
2148 groebnerMatrix(62,68) = -groebnerMatrix(38,171)/(groebnerMatrix(38,161));
2149 groebnerMatrix(62,70) = -groebnerMatrix(38,173)/(groebnerMatrix(38,161));
2150 groebnerMatrix(62,74) = -groebnerMatrix(38,174)/(groebnerMatrix(38,161));
2151 groebnerMatrix(62,76) = groebnerMatrix(32,170)/(groebnerMatrix(32,155));
2152 groebnerMatrix(62,77) = groebnerMatrix(32,171)/(groebnerMatrix(32,155));
2153 groebnerMatrix(62,79) = groebnerMatrix(32,173)/(groebnerMatrix(32,155));
2154 groebnerMatrix(62,80) = groebnerMatrix(32,174)/(groebnerMatrix(32,155));
2155 groebnerMatrix(62,85) = -groebnerMatrix(38,176)/(groebnerMatrix(38,161));
2156 groebnerMatrix(62,87) = groebnerMatrix(32,176)/(groebnerMatrix(32,155));
2157 groebnerMatrix(62,92) = -groebnerMatrix(38,177)/(groebnerMatrix(38,161));
2158 groebnerMatrix(62,94) = groebnerMatrix(32,177)/(groebnerMatrix(32,155));
2159 groebnerMatrix(62,103) = -groebnerMatrix(38,178)/(groebnerMatrix(38,161));
2160 groebnerMatrix(62,104) = -groebnerMatrix(38,179)/(groebnerMatrix(38,161));
2161 groebnerMatrix(62,105) = -groebnerMatrix(38,180)/(groebnerMatrix(38,161));
2162 groebnerMatrix(62,106) = -groebnerMatrix(38,181)/(groebnerMatrix(38,161));
2163 groebnerMatrix(62,110) = -groebnerMatrix(38,182)/(groebnerMatrix(38,161));
2164 groebnerMatrix(62,112) = groebnerMatrix(32,178)/(groebnerMatrix(32,155));
2165 groebnerMatrix(62,113) = groebnerMatrix(32,179)/(groebnerMatrix(32,155));
2166 groebnerMatrix(62,114) = groebnerMatrix(32,180)/(groebnerMatrix(32,155));
2167 groebnerMatrix(62,115) = (groebnerMatrix(32,181)/(groebnerMatrix(32,155))-groebnerMatrix(38,183)/(groebnerMatrix(38,161)));
2168 groebnerMatrix(62,116) = groebnerMatrix(32,182)/(groebnerMatrix(32,155));
2169 groebnerMatrix(62,117) = groebnerMatrix(32,183)/(groebnerMatrix(32,155));
2170 groebnerMatrix(62,121) = -groebnerMatrix(38,184)/(groebnerMatrix(38,161));
2171 groebnerMatrix(62,123) = groebnerMatrix(32,184)/(groebnerMatrix(32,155));
2172 groebnerMatrix(62,128) = -groebnerMatrix(38,185)/(groebnerMatrix(38,161));
2173 groebnerMatrix(62,130) = groebnerMatrix(32,185)/(groebnerMatrix(32,155));
2174 groebnerMatrix(62,136) = -groebnerMatrix(38,186)/(groebnerMatrix(38,161));
2175 groebnerMatrix(62,138) = groebnerMatrix(32,186)/(groebnerMatrix(32,155));
2176 groebnerMatrix(62,148) = -groebnerMatrix(38,187)/(groebnerMatrix(38,161));
2177 groebnerMatrix(62,149) = -groebnerMatrix(38,188)/(groebnerMatrix(38,161));
2178 groebnerMatrix(62,150) = -groebnerMatrix(38,189)/(groebnerMatrix(38,161));
2179 groebnerMatrix(62,151) = -groebnerMatrix(38,190)/(groebnerMatrix(38,161));
2180 groebnerMatrix(62,155) = -groebnerMatrix(38,191)/(groebnerMatrix(38,161));
2181 groebnerMatrix(62,157) = groebnerMatrix(32,187)/(groebnerMatrix(32,155));
2182 groebnerMatrix(62,158) = groebnerMatrix(32,188)/(groebnerMatrix(32,155));
2183 groebnerMatrix(62,159) = groebnerMatrix(32,189)/(groebnerMatrix(32,155));
2184 groebnerMatrix(62,160) = (groebnerMatrix(32,190)/(groebnerMatrix(32,155))-groebnerMatrix(38,192)/(groebnerMatrix(38,161)));
2185 groebnerMatrix(62,161) = groebnerMatrix(32,191)/(groebnerMatrix(32,155));
2186 groebnerMatrix(62,162) = groebnerMatrix(32,192)/(groebnerMatrix(32,155));
2187 groebnerMatrix(62,166) = -groebnerMatrix(38,193)/(groebnerMatrix(38,161));
2188 groebnerMatrix(62,168) = groebnerMatrix(32,193)/(groebnerMatrix(32,155));
2189 groebnerMatrix(62,173) = -groebnerMatrix(38,194)/(groebnerMatrix(38,161));
2190 groebnerMatrix(62,175) = groebnerMatrix(32,194)/(groebnerMatrix(32,155));
2191 groebnerMatrix(62,181) = -groebnerMatrix(38,195)/(groebnerMatrix(38,161));
2192 groebnerMatrix(62,183) = groebnerMatrix(32,195)/(groebnerMatrix(32,155));
2193 groebnerMatrix(62,190) = -groebnerMatrix(38,196)/(groebnerMatrix(38,161));
2194 groebnerMatrix(62,192) = groebnerMatrix(32,196)/(groebnerMatrix(32,155));
2195 }
2196
2197 void
sPolynomial63(Eigen::Matrix<double,66,197> & groebnerMatrix)2198 opengv::relative_pose::modules::fivept_kneip::sPolynomial63( Eigen::Matrix<double,66,197> & groebnerMatrix )
2199 {
2200 groebnerMatrix(63,31) = -groebnerMatrix(36,160)/(groebnerMatrix(36,159));
2201 groebnerMatrix(63,32) = -groebnerMatrix(36,161)/(groebnerMatrix(36,159));
2202 groebnerMatrix(63,34) = groebnerMatrix(16,158)/(groebnerMatrix(16,154));
2203 groebnerMatrix(63,37) = -groebnerMatrix(36,162)/(groebnerMatrix(36,159));
2204 groebnerMatrix(63,71) = -groebnerMatrix(36,170)/(groebnerMatrix(36,159));
2205 groebnerMatrix(63,72) = -groebnerMatrix(36,171)/(groebnerMatrix(36,159));
2206 groebnerMatrix(63,74) = -groebnerMatrix(36,173)/(groebnerMatrix(36,159));
2207 groebnerMatrix(63,75) = -groebnerMatrix(36,174)/(groebnerMatrix(36,159));
2208 groebnerMatrix(63,86) = -groebnerMatrix(36,176)/(groebnerMatrix(36,159));
2209 groebnerMatrix(63,93) = -groebnerMatrix(36,177)/(groebnerMatrix(36,159));
2210 groebnerMatrix(63,107) = -groebnerMatrix(36,178)/(groebnerMatrix(36,159));
2211 groebnerMatrix(63,108) = -groebnerMatrix(36,179)/(groebnerMatrix(36,159));
2212 groebnerMatrix(63,109) = -groebnerMatrix(36,180)/(groebnerMatrix(36,159));
2213 groebnerMatrix(63,110) = -groebnerMatrix(36,181)/(groebnerMatrix(36,159));
2214 groebnerMatrix(63,111) = -groebnerMatrix(36,182)/(groebnerMatrix(36,159));
2215 groebnerMatrix(63,116) = -groebnerMatrix(36,183)/(groebnerMatrix(36,159));
2216 groebnerMatrix(63,122) = -groebnerMatrix(36,184)/(groebnerMatrix(36,159));
2217 groebnerMatrix(63,129) = -groebnerMatrix(36,185)/(groebnerMatrix(36,159));
2218 groebnerMatrix(63,137) = -groebnerMatrix(36,186)/(groebnerMatrix(36,159));
2219 groebnerMatrix(63,152) = -groebnerMatrix(36,187)/(groebnerMatrix(36,159));
2220 groebnerMatrix(63,153) = -groebnerMatrix(36,188)/(groebnerMatrix(36,159));
2221 groebnerMatrix(63,154) = -groebnerMatrix(36,189)/(groebnerMatrix(36,159));
2222 groebnerMatrix(63,155) = -groebnerMatrix(36,190)/(groebnerMatrix(36,159));
2223 groebnerMatrix(63,156) = -groebnerMatrix(36,191)/(groebnerMatrix(36,159));
2224 groebnerMatrix(63,161) = -groebnerMatrix(36,192)/(groebnerMatrix(36,159));
2225 groebnerMatrix(63,167) = -groebnerMatrix(36,193)/(groebnerMatrix(36,159));
2226 groebnerMatrix(63,168) = groebnerMatrix(16,193)/(groebnerMatrix(16,154));
2227 groebnerMatrix(63,174) = -groebnerMatrix(36,194)/(groebnerMatrix(36,159));
2228 groebnerMatrix(63,182) = -groebnerMatrix(36,195)/(groebnerMatrix(36,159));
2229 groebnerMatrix(63,191) = -groebnerMatrix(36,196)/(groebnerMatrix(36,159));
2230 }
2231
2232 void
sPolynomial64(Eigen::Matrix<double,66,197> & groebnerMatrix)2233 opengv::relative_pose::modules::fivept_kneip::sPolynomial64( Eigen::Matrix<double,66,197> & groebnerMatrix )
2234 {
2235 groebnerMatrix(64,34) = groebnerMatrix(16,158)/(groebnerMatrix(16,154));
2236 groebnerMatrix(64,35) = -groebnerMatrix(38,162)/(groebnerMatrix(38,161));
2237 groebnerMatrix(64,64) = -groebnerMatrix(38,170)/(groebnerMatrix(38,161));
2238 groebnerMatrix(64,65) = -groebnerMatrix(38,171)/(groebnerMatrix(38,161));
2239 groebnerMatrix(64,69) = -groebnerMatrix(38,173)/(groebnerMatrix(38,161));
2240 groebnerMatrix(64,73) = -groebnerMatrix(38,174)/(groebnerMatrix(38,161));
2241 groebnerMatrix(64,84) = -groebnerMatrix(38,176)/(groebnerMatrix(38,161));
2242 groebnerMatrix(64,91) = -groebnerMatrix(38,177)/(groebnerMatrix(38,161));
2243 groebnerMatrix(64,100) = -groebnerMatrix(38,178)/(groebnerMatrix(38,161));
2244 groebnerMatrix(64,101) = -groebnerMatrix(38,179)/(groebnerMatrix(38,161));
2245 groebnerMatrix(64,102) = -groebnerMatrix(38,180)/(groebnerMatrix(38,161));
2246 groebnerMatrix(64,105) = -groebnerMatrix(38,181)/(groebnerMatrix(38,161));
2247 groebnerMatrix(64,109) = -groebnerMatrix(38,182)/(groebnerMatrix(38,161));
2248 groebnerMatrix(64,114) = -groebnerMatrix(38,183)/(groebnerMatrix(38,161));
2249 groebnerMatrix(64,120) = -groebnerMatrix(38,184)/(groebnerMatrix(38,161));
2250 groebnerMatrix(64,127) = -groebnerMatrix(38,185)/(groebnerMatrix(38,161));
2251 groebnerMatrix(64,135) = -groebnerMatrix(38,186)/(groebnerMatrix(38,161));
2252 groebnerMatrix(64,145) = -groebnerMatrix(38,187)/(groebnerMatrix(38,161));
2253 groebnerMatrix(64,146) = -groebnerMatrix(38,188)/(groebnerMatrix(38,161));
2254 groebnerMatrix(64,147) = -groebnerMatrix(38,189)/(groebnerMatrix(38,161));
2255 groebnerMatrix(64,150) = -groebnerMatrix(38,190)/(groebnerMatrix(38,161));
2256 groebnerMatrix(64,154) = -groebnerMatrix(38,191)/(groebnerMatrix(38,161));
2257 groebnerMatrix(64,159) = -groebnerMatrix(38,192)/(groebnerMatrix(38,161));
2258 groebnerMatrix(64,165) = -groebnerMatrix(38,193)/(groebnerMatrix(38,161));
2259 groebnerMatrix(64,168) = groebnerMatrix(16,193)/(groebnerMatrix(16,154));
2260 groebnerMatrix(64,172) = -groebnerMatrix(38,194)/(groebnerMatrix(38,161));
2261 groebnerMatrix(64,180) = -groebnerMatrix(38,195)/(groebnerMatrix(38,161));
2262 groebnerMatrix(64,189) = -groebnerMatrix(38,196)/(groebnerMatrix(38,161));
2263 }
2264
2265 void
sPolynomial65(Eigen::Matrix<double,66,197> & groebnerMatrix)2266 opengv::relative_pose::modules::fivept_kneip::sPolynomial65( Eigen::Matrix<double,66,197> & groebnerMatrix )
2267 {
2268 groebnerMatrix(65,30) = -groebnerMatrix(35,159)/(groebnerMatrix(35,158));
2269 groebnerMatrix(65,31) = (groebnerMatrix(31,155)/(groebnerMatrix(31,153))-groebnerMatrix(35,160)/(groebnerMatrix(35,158)));
2270 groebnerMatrix(65,32) = (groebnerMatrix(31,156)/(groebnerMatrix(31,153))-groebnerMatrix(35,161)/(groebnerMatrix(35,158)));
2271 groebnerMatrix(65,33) = groebnerMatrix(31,157)/(groebnerMatrix(31,153));
2272 groebnerMatrix(65,34) = groebnerMatrix(31,158)/(groebnerMatrix(31,153));
2273 groebnerMatrix(65,35) = groebnerMatrix(31,159)/(groebnerMatrix(31,153));
2274 groebnerMatrix(65,36) = groebnerMatrix(31,160)/(groebnerMatrix(31,153));
2275 groebnerMatrix(65,37) = (groebnerMatrix(31,161)/(groebnerMatrix(31,153))-groebnerMatrix(35,162)/(groebnerMatrix(35,158)));
2276 groebnerMatrix(65,38) = groebnerMatrix(31,162)/(groebnerMatrix(31,153));
2277 groebnerMatrix(65,71) = -groebnerMatrix(35,170)/(groebnerMatrix(35,158));
2278 groebnerMatrix(65,72) = -groebnerMatrix(35,171)/(groebnerMatrix(35,158));
2279 groebnerMatrix(65,74) = -groebnerMatrix(35,173)/(groebnerMatrix(35,158));
2280 groebnerMatrix(65,75) = -groebnerMatrix(35,174)/(groebnerMatrix(35,158));
2281 groebnerMatrix(65,76) = groebnerMatrix(31,170)/(groebnerMatrix(31,153));
2282 groebnerMatrix(65,77) = groebnerMatrix(31,171)/(groebnerMatrix(31,153));
2283 groebnerMatrix(65,79) = groebnerMatrix(31,173)/(groebnerMatrix(31,153));
2284 groebnerMatrix(65,80) = groebnerMatrix(31,174)/(groebnerMatrix(31,153));
2285 groebnerMatrix(65,86) = -groebnerMatrix(35,176)/(groebnerMatrix(35,158));
2286 groebnerMatrix(65,87) = groebnerMatrix(31,176)/(groebnerMatrix(31,153));
2287 groebnerMatrix(65,93) = -groebnerMatrix(35,177)/(groebnerMatrix(35,158));
2288 groebnerMatrix(65,94) = groebnerMatrix(31,177)/(groebnerMatrix(31,153));
2289 groebnerMatrix(65,107) = -groebnerMatrix(35,178)/(groebnerMatrix(35,158));
2290 groebnerMatrix(65,108) = -groebnerMatrix(35,179)/(groebnerMatrix(35,158));
2291 groebnerMatrix(65,109) = -groebnerMatrix(35,180)/(groebnerMatrix(35,158));
2292 groebnerMatrix(65,110) = -groebnerMatrix(35,181)/(groebnerMatrix(35,158));
2293 groebnerMatrix(65,111) = -groebnerMatrix(35,182)/(groebnerMatrix(35,158));
2294 groebnerMatrix(65,112) = groebnerMatrix(31,178)/(groebnerMatrix(31,153));
2295 groebnerMatrix(65,113) = groebnerMatrix(31,179)/(groebnerMatrix(31,153));
2296 groebnerMatrix(65,114) = groebnerMatrix(31,180)/(groebnerMatrix(31,153));
2297 groebnerMatrix(65,115) = groebnerMatrix(31,181)/(groebnerMatrix(31,153));
2298 groebnerMatrix(65,116) = (groebnerMatrix(31,182)/(groebnerMatrix(31,153))-groebnerMatrix(35,183)/(groebnerMatrix(35,158)));
2299 groebnerMatrix(65,117) = groebnerMatrix(31,183)/(groebnerMatrix(31,153));
2300 groebnerMatrix(65,122) = -groebnerMatrix(35,184)/(groebnerMatrix(35,158));
2301 groebnerMatrix(65,123) = groebnerMatrix(31,184)/(groebnerMatrix(31,153));
2302 groebnerMatrix(65,129) = -groebnerMatrix(35,185)/(groebnerMatrix(35,158));
2303 groebnerMatrix(65,130) = groebnerMatrix(31,185)/(groebnerMatrix(31,153));
2304 groebnerMatrix(65,137) = -groebnerMatrix(35,186)/(groebnerMatrix(35,158));
2305 groebnerMatrix(65,138) = groebnerMatrix(31,186)/(groebnerMatrix(31,153));
2306 groebnerMatrix(65,152) = -groebnerMatrix(35,187)/(groebnerMatrix(35,158));
2307 groebnerMatrix(65,153) = -groebnerMatrix(35,188)/(groebnerMatrix(35,158));
2308 groebnerMatrix(65,154) = -groebnerMatrix(35,189)/(groebnerMatrix(35,158));
2309 groebnerMatrix(65,155) = -groebnerMatrix(35,190)/(groebnerMatrix(35,158));
2310 groebnerMatrix(65,156) = -groebnerMatrix(35,191)/(groebnerMatrix(35,158));
2311 groebnerMatrix(65,157) = groebnerMatrix(31,187)/(groebnerMatrix(31,153));
2312 groebnerMatrix(65,158) = groebnerMatrix(31,188)/(groebnerMatrix(31,153));
2313 groebnerMatrix(65,159) = groebnerMatrix(31,189)/(groebnerMatrix(31,153));
2314 groebnerMatrix(65,160) = groebnerMatrix(31,190)/(groebnerMatrix(31,153));
2315 groebnerMatrix(65,161) = (groebnerMatrix(31,191)/(groebnerMatrix(31,153))-groebnerMatrix(35,192)/(groebnerMatrix(35,158)));
2316 groebnerMatrix(65,162) = groebnerMatrix(31,192)/(groebnerMatrix(31,153));
2317 groebnerMatrix(65,167) = -groebnerMatrix(35,193)/(groebnerMatrix(35,158));
2318 groebnerMatrix(65,168) = groebnerMatrix(31,193)/(groebnerMatrix(31,153));
2319 groebnerMatrix(65,174) = -groebnerMatrix(35,194)/(groebnerMatrix(35,158));
2320 groebnerMatrix(65,175) = groebnerMatrix(31,194)/(groebnerMatrix(31,153));
2321 groebnerMatrix(65,182) = -groebnerMatrix(35,195)/(groebnerMatrix(35,158));
2322 groebnerMatrix(65,183) = groebnerMatrix(31,195)/(groebnerMatrix(31,153));
2323 groebnerMatrix(65,191) = -groebnerMatrix(35,196)/(groebnerMatrix(35,158));
2324 groebnerMatrix(65,192) = groebnerMatrix(31,196)/(groebnerMatrix(31,153));
2325 }
2326
2327