@@ -84,57 +84,55 @@ BuildHDMap::BuildHDMap() {
84
84
85
85
// 内参都一样
86
86
// for (int i = 0; i < 4; i++) { //gcc可以通过,cl编译器必须逐个赋值
87
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
88
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
89
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
90
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
91
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
92
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
93
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
94
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
95
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
96
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
97
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
98
- m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .Skew = 0 ;
99
-
100
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
101
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
102
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
103
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
104
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
105
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
106
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
107
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
108
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
109
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
110
- m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .Skew = 0 ;
111
-
112
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
113
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
114
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
115
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
116
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
117
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
118
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
119
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
120
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
121
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
122
- m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .Skew = 0 ;
123
-
124
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
125
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
126
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
127
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
128
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
129
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
130
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
131
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
132
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
133
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
134
- m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .Skew = 0 ;
135
- // }
136
- spdlog::info (" check focal len:{},{}" , m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [0 ], m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [1 ]);
137
-
87
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
88
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
89
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
90
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
91
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
92
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
93
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
94
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
95
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
96
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
97
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
98
+ m_birdsEye360CaliParameter.birdsEye [0 ].Sensor .Intrinsics .Skew = 0 ;
99
+
100
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
101
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
102
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
103
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
104
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
105
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
106
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
107
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
108
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
109
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
110
+ m_birdsEye360CaliParameter.birdsEye [1 ].Sensor .Intrinsics .Skew = 0 ;
111
+
112
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
113
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
114
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
115
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
116
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
117
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
118
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
119
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
120
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
121
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
122
+ m_birdsEye360CaliParameter.birdsEye [2 ].Sensor .Intrinsics .Skew = 0 ;
123
+
124
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .FocalLength [0 ] = 317.8183 ;
125
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .FocalLength [1 ] = 317.8183 ;
126
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .PrincipalPoint [0 ] = 2866.778010428930429 ;
127
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .PrincipalPoint [1 ] = 529.816904864335 ;
128
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .ImageSize [0 ] = 1063 ;
129
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .ImageSize [1 ] = 5796 ;
130
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .RadialDistortion [0 ] = 0 ,
131
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .RadialDistortion [1 ] = 0 ;
132
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .TangentialDistortion [0 ] = 0 ;
133
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .TangentialDistortion [1 ] = 0 ;
134
+ m_birdsEye360CaliParameter.birdsEye [3 ].Sensor .Intrinsics .Skew = 0 ;
135
+ // }
138
136
139
137
// // 四副环视图到基准第一个到转换,gcc可以通过,cl编译器必须逐个赋值
140
138
// auto init0 = std::initializer_list<double>({1, 0, 0, 0, 1, 0, 0, 0, 1});
@@ -146,51 +144,51 @@ BuildHDMap::BuildHDMap() {
146
144
// auto init3 = std::initializer_list<double>({0.5489015, -0.01142391, 0, 0.003611683, 0.5398036, 0, 317.7876, 53.31789, 1});
147
145
// std::copy(init3.begin(), init3.end(), m_birdsEye360CaliParameter.tforms[3].A);
148
146
149
- m_birdsEye360CaliParameter.tforms [0 ].A [0 ] = 1 ;
150
- m_birdsEye360CaliParameter.tforms [0 ].A [1 ] = 0 ;
151
- m_birdsEye360CaliParameter.tforms [0 ].A [2 ] = 0 ;
152
- m_birdsEye360CaliParameter.tforms [0 ].A [3 ] = 0 ;
153
- m_birdsEye360CaliParameter.tforms [0 ].A [4 ] = 1 ;
154
- m_birdsEye360CaliParameter.tforms [0 ].A [5 ] = 0 ;
155
- m_birdsEye360CaliParameter.tforms [0 ].A [6 ] = 0 ;
156
- m_birdsEye360CaliParameter.tforms [0 ].A [7 ] = 0 ;
157
- m_birdsEye360CaliParameter.tforms [0 ].A [8 ] = 1 ;
158
-
159
- m_birdsEye360CaliParameter.tforms [1 ].A [0 ] = 0.539859 ;
160
- m_birdsEye360CaliParameter.tforms [1 ].A [1 ] = -0.0114774 ;
161
- m_birdsEye360CaliParameter.tforms [1 ].A [2 ] = 0 ;
162
- m_birdsEye360CaliParameter.tforms [1 ].A [3 ] = 0.00148547 ;
163
- m_birdsEye360CaliParameter.tforms [1 ].A [4 ] = 0.54053 ;
164
- m_birdsEye360CaliParameter.tforms [1 ].A [5 ] = 0 ;
165
- m_birdsEye360CaliParameter.tforms [1 ].A [6 ] = -25.6848 ;
166
- m_birdsEye360CaliParameter.tforms [1 ].A [7 ] = 58.0006 ;
167
- m_birdsEye360CaliParameter.tforms [1 ].A [8 ] = 1 ;
168
-
169
- m_birdsEye360CaliParameter.tforms [2 ].A [0 ] = 0.9945768 ;
170
- m_birdsEye360CaliParameter.tforms [2 ].A [1 ] = -0.03405895 ;
171
- m_birdsEye360CaliParameter.tforms [2 ].A [2 ] = 0 ;
172
- m_birdsEye360CaliParameter.tforms [2 ].A [3 ] = -0.003624775 ;
173
- m_birdsEye360CaliParameter.tforms [2 ].A [4 ] = 0.9873774 ;
174
- m_birdsEye360CaliParameter.tforms [2 ].A [5 ] = 0 ;
175
- m_birdsEye360CaliParameter.tforms [2 ].A [6 ] = 0.5879876 ;
176
- m_birdsEye360CaliParameter.tforms [2 ].A [7 ] = 430.9479 ;
177
- m_birdsEye360CaliParameter.tforms [2 ].A [8 ] = 1 ;
178
-
179
- m_birdsEye360CaliParameter.tforms [3 ].A [0 ] = 0.5489015 ;
180
- m_birdsEye360CaliParameter.tforms [3 ].A [1 ] = -0.01142391 ;
181
- m_birdsEye360CaliParameter.tforms [3 ].A [2 ] = 0 ;
182
- m_birdsEye360CaliParameter.tforms [3 ].A [3 ] = 0.003611683 ;
183
- m_birdsEye360CaliParameter.tforms [3 ].A [4 ] = 0.5398036 ;
184
- m_birdsEye360CaliParameter.tforms [3 ].A [5 ] = 0 ;
185
- m_birdsEye360CaliParameter.tforms [3 ].A [6 ] = 317.7876 ;
186
- m_birdsEye360CaliParameter.tforms [3 ].A [7 ] = 53.31789 ;
187
- m_birdsEye360CaliParameter.tforms [3 ].A [8 ] = 1 ;
147
+ m_birdsEye360CaliParameter.tforms [0 ].A [0 ] = 1 ;
148
+ m_birdsEye360CaliParameter.tforms [0 ].A [1 ] = 0 ;
149
+ m_birdsEye360CaliParameter.tforms [0 ].A [2 ] = 0 ;
150
+ m_birdsEye360CaliParameter.tforms [0 ].A [3 ] = 0 ;
151
+ m_birdsEye360CaliParameter.tforms [0 ].A [4 ] = 1 ;
152
+ m_birdsEye360CaliParameter.tforms [0 ].A [5 ] = 0 ;
153
+ m_birdsEye360CaliParameter.tforms [0 ].A [6 ] = 0 ;
154
+ m_birdsEye360CaliParameter.tforms [0 ].A [7 ] = 0 ;
155
+ m_birdsEye360CaliParameter.tforms [0 ].A [8 ] = 1 ;
156
+
157
+ m_birdsEye360CaliParameter.tforms [1 ].A [0 ] = 0.539859 ;
158
+ m_birdsEye360CaliParameter.tforms [1 ].A [1 ] = -0.0114774 ;
159
+ m_birdsEye360CaliParameter.tforms [1 ].A [2 ] = 0 ;
160
+ m_birdsEye360CaliParameter.tforms [1 ].A [3 ] = 0.00148547 ;
161
+ m_birdsEye360CaliParameter.tforms [1 ].A [4 ] = 0.54053 ;
162
+ m_birdsEye360CaliParameter.tforms [1 ].A [5 ] = 0 ;
163
+ m_birdsEye360CaliParameter.tforms [1 ].A [6 ] = -25.6848 ;
164
+ m_birdsEye360CaliParameter.tforms [1 ].A [7 ] = 58.0006 ;
165
+ m_birdsEye360CaliParameter.tforms [1 ].A [8 ] = 1 ;
166
+
167
+ m_birdsEye360CaliParameter.tforms [2 ].A [0 ] = 0.9945768 ;
168
+ m_birdsEye360CaliParameter.tforms [2 ].A [1 ] = -0.03405895 ;
169
+ m_birdsEye360CaliParameter.tforms [2 ].A [2 ] = 0 ;
170
+ m_birdsEye360CaliParameter.tforms [2 ].A [3 ] = -0.003624775 ;
171
+ m_birdsEye360CaliParameter.tforms [2 ].A [4 ] = 0.9873774 ;
172
+ m_birdsEye360CaliParameter.tforms [2 ].A [5 ] = 0 ;
173
+ m_birdsEye360CaliParameter.tforms [2 ].A [6 ] = 0.5879876 ;
174
+ m_birdsEye360CaliParameter.tforms [2 ].A [7 ] = 430.9479 ;
175
+ m_birdsEye360CaliParameter.tforms [2 ].A [8 ] = 1 ;
176
+
177
+ m_birdsEye360CaliParameter.tforms [3 ].A [0 ] = 0.5489015 ;
178
+ m_birdsEye360CaliParameter.tforms [3 ].A [1 ] = -0.01142391 ;
179
+ m_birdsEye360CaliParameter.tforms [3 ].A [2 ] = 0 ;
180
+ m_birdsEye360CaliParameter.tforms [3 ].A [3 ] = 0.003611683 ;
181
+ m_birdsEye360CaliParameter.tforms [3 ].A [4 ] = 0.5398036 ;
182
+ m_birdsEye360CaliParameter.tforms [3 ].A [5 ] = 0 ;
183
+ m_birdsEye360CaliParameter.tforms [3 ].A [6 ] = 317.7876 ;
184
+ m_birdsEye360CaliParameter.tforms [3 ].A [7 ] = 53.31789 ;
185
+ m_birdsEye360CaliParameter.tforms [3 ].A [8 ] = 1 ;
188
186
}
189
187
190
188
struct6_T BuildHDMap::Run (struct0_T &inputArgsPose) {
191
189
struct6_T outputStruct = m_outputStruct;
192
-
193
- constructWorldMap (&inputArgsPose, &m_birdsEye360CaliParameter, &outputStruct);
190
+
191
+ constructWorldMap (&inputArgsPose, &m_birdsEye360CaliParameter, &outputStruct);
194
192
195
193
return outputStruct;
196
194
}
0 commit comments