#pragma once
#include <opencv2/opencv.hpp>
#include <opencv2/highgui/highgui_c.h>
#include <iostream>
#include <Eigen/Core>
using std::cout;
using std::endl;


void PNP(const cv::Mat& img, std::vector<cv::Point2f> points, cv::Mat cam, cv::Mat dis);