Member Detector::findSquare (cv::Mat &image, std::vector< std::vector< cv::Point >> *found4CornersVector, int threshLevels=11, int cannyThresh=50)
various parameters are hardcoded in _findSquares. Maybe they can be setted from external caller.
Member KDLHelper::getFixedFrame (std::string frameOrigin, std::string frameTarget, Eigen::Matrix4d *xTx_eigen)
Maybe exist an easier method to parse fixed frame from urdf without needed of kdl solver: The other method is to use the tf listener (in world interface) but it is a ros inteface so specifically only if simulator used publish frame positions on ros