| 184 | } |
| 185 | |
| 186 | Eigen::Matrix4d |
| 187 | readMatrixFromFile (std::string filename) |
| 188 | { |
| 189 | Eigen::Matrix4d matrix; |
| 190 | std::string line; |
| 191 | std::ifstream myfile (filename.c_str()); |
| 192 | if (myfile.is_open()) |
| 193 | { |
| 194 | int k = 0; |
| 195 | std::string number; |
| 196 | while (myfile >> number) |
| 197 | { |
| 198 | matrix(int(k/4), int(k%4)) = std::atof(number.c_str()); |
| 199 | k++; |
| 200 | } |
| 201 | myfile.close(); |
| 202 | } |
| 203 | |
| 204 | std::cout << matrix << std::endl; |
| 205 | |
| 206 | return matrix; |
| 207 | } |
| 208 | |
| 209 | /** |
| 210 | * \brief Read the DetectionArray message and use the detections for creating/updating/deleting tracks |
no test coverage detected