avana/sagoma
2
1
Fork 1
Code Issues Pull requests Releases Wiki Activity

Point identification complete

Browse source
This commit is contained in:
boyska 2017-01-13 00:16:22 +01:00
parent d044199220
commit 836270b9aa
3 changed files with 43 additions and 29 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

20
geometry.cpp
View file

@ -110,3 +110,23 @@ is_above_line(cv::Vec<double,3> line, Point p)
{
return line(0)*p.x + line(1)*p.y + line(2) > 0;
}
cv::Point
further_point_from_line(cv::Vec<double,3> line, std::vector<Point> points)
{
//distance = abs(a*p.x+b*p.y+c) / sqrt(a^2+b^2)
double denom = sqrt(line(0)*line(0)+line(1)*line(1));
Point further = points[0];
double maxdist = -1;
std::cout << "--- further" << std::endl;
for(Point p: points)
{
double numerator = abs(line(0)*p.x + line(1)*p.y + line(2));
double distance = numerator/denom;
if(distance > maxdist) {
maxdist = distance;
further = p;
}
}
return further;
}

1
geometry.h
View file

@ -11,6 +11,7 @@ cv::Point unmap_point(double, cv::Point, cv::Point);
cv::Vec<double,3> get_line(cv::Point, cv::Point);
bool is_in_line(cv::Vec<double,3> line, cv::Point p);
bool is_above_line(cv::Vec<double,3> line, cv::Point p);
cv::Point further_point_from_line(cv::Vec<double,3>, std::vector<cv::Point>);
class CoordinateSystem
{

51
lines.cpp
View file

@ -44,7 +44,6 @@ int main(int argc, char *argv[])
cv::findContours(img,contours,hierarchy,CV_RETR_EXTERNAL,CV_CHAIN_APPROX_SIMPLE);
unsigned short dotwidth = img.cols >> 6; // divide by 64, so efficient
//img = cv::imread(fname,CV_LOAD_IMAGE_COLOR); // uncomment to this to display image with colors
cv::drawContours(img,contours,-1,BROWN,dotwidth>>4);
if( 0==contours.size() ) {
@ -77,10 +76,6 @@ int main(int argc, char *argv[])
img = cv::imread(fname,CV_LOAD_IMAGE_COLOR); // uncomment to this to display image with colors
std::cout << "Maxdist1:" << maxdistances[0] << " " << corn_1 << corn_2 << std::endl;
std::cout << "Maxdist2:" << maxdistances[1] << " " << corn_3 << corn_4 << std::endl;
cv::circle(img,corn_1,dotwidth>>1,MAGENTA,2);
cv::circle(img,corn_2,dotwidth>>2,MAGENTA,2);
cv::circle(img,corn_3,dotwidth>>2,BROWN,2);
cv::circle(img,corn_4,dotwidth>>2,BROWN,2);
cv::namedWindow("win", CV_GUI_NORMAL);
// cv::imshow("4 corners",img);
// cv::waitKey(0);
@ -94,26 +89,8 @@ int main(int argc, char *argv[])
verticals.push_back(find_longest_line(hull, (maxdistances[1]+1)%hull.size(), maxdistances[0]));
free(maxdistances);
#ifdef _DEBUG
//img = cv::imread(fname,CV_LOAD_IMAGE_COLOR); // uncomment to this to display image with colors
auto color = MAGENTA;
for( auto line: verticals )
{
color = (color==BLUE) ? MAGENTA : BLUE; //flip color for the two lines
cv::Point p1 = line[0];
cv::Point p2 = line[line.size()-1];
cv::line(img, p1, p2, color, dotwidth>>4);
std::cout << "vertical: " << line[0] << line[line.size()-1] << std::endl;
for(cv::Point p: line)
{
cv::circle(img,p,dotwidth>>3,color,-1);
}
}
#endif
// theta is the angle of the line connecting point 1 and 2; it will be the
// rotation of our new coordinate system
double theta = atan(((double)corn_2.y-corn_1.y) / ((double)corn_2.x-corn_1.x));
auto cs = CoordinateSystem(corn_1, corn_2);
assert(cs.map(corn_1).x == 0);
assert(cs.map(corn_1).y == 0);
@ -122,24 +99,40 @@ int main(int argc, char *argv[])
cv::Vec<double,3> diag1, diag2;
diag1 = get_line(cs.map(corn_1), cs.map(corn_3));
diag2 = get_line(cs.map(corn_4), cs.map(corn_2));
cv::line(img, corn_1, corn_3, BLUE, dotwidth>>4);
cv::line(img, corn_2, corn_4, MAGENTA, dotwidth>>4);
std::cout << "mapped diag1: " << diag1 << std::endl;
std::cout << "mapped diag2: " << diag2 << std::endl;
std::vector<cv::Point> points1, points2;
for(cv::Point p: contour)
{
{ // the point is interesting where it is above both lines or below both lines
cv::Point mapped = cs.map(p);
if(is_above_line(diag1, mapped) == is_above_line(diag2, mapped)) {
cv::circle(img, p, dotwidth>>3, YELLOW,-1);
if(is_above_line(diag1, mapped)) {
if(is_above_line(diag2, mapped)) {
points1.push_back(p);
}
} else {
if(!is_above_line(diag2, mapped)) {
points2.push_back(p);
}
}
}
#ifdef _DEBUG
cv::Point middle1 = further_point_from_line(get_line(corn_1, corn_2), points2);
cv::Point middle2 = further_point_from_line(get_line(corn_3, corn_4), points1);
cv::line(img, corn_1, middle1, MAGENTA, dotwidth>>3);
cv::line(img, corn_2, middle1, MAGENTA, dotwidth>>3);
cv::line(img, middle1, middle2, BLACK, dotwidth>>4);
cv::line(img, corn_3, middle2, MAGENTA, dotwidth>>3);
cv::line(img, corn_4, middle2, MAGENTA, dotwidth>>3);
cv::line(img, corn_2, corn_3, BLUE, dotwidth>>4);
cv::line(img, corn_1, corn_4, BLUE, dotwidth>>4);
std::cout << middle1 << middle2 << std::endl;
cv::imshow("win",img);
while(1)
{
if( cv::waitKey(0) == 113 )
if( (char)cv::waitKey(0) == 113 )
break;
}
img.release();