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