X-Git-Url: http://git.cinelerra-gg.org/git/?a=blobdiff_plain;f=cinelerra-5.1%2Fplugins%2Ffindobj%2Ffindobj.C;h=6815fd1aaf233e77b939a65bafb0d98ff6de8eb3;hb=08284a3a20b2cc8606dd90c3c147e2c31d301a61;hp=7909170a3941a0cc1f3d8746eba2d2b329ff2c72;hpb=8aa6d71ebd2c65785a8b553fc6fc38ac19041ce0;p=goodguy%2Fhistory.git diff --git a/cinelerra-5.1/plugins/findobj/findobj.C b/cinelerra-5.1/plugins/findobj/findobj.C index 7909170a..6815fd1a 100644 --- a/cinelerra-5.1/plugins/findobj/findobj.C +++ b/cinelerra-5.1/plugins/findobj/findobj.C @@ -46,6 +46,12 @@ void FindObjConfig::reset() { algorithm = NO_ALGORITHM; use_flann = 1; + mode = MODE_QUADRILATERAL; + draw_match = 0; + aspect = 1; + scale = 1; + translate = 1; + rotate = 1; draw_keypoints = 0; draw_scene_border = 0; replace_object = 0; @@ -84,7 +90,13 @@ int FindObjConfig::equivalent(FindObjConfig &that) int result = algorithm == that.algorithm && use_flann == that.use_flann && + mode == that.mode && + aspect == that.aspect && + scale == that.scale && + translate == that.translate && + rotate == that.rotate && draw_keypoints == that.draw_keypoints && + draw_match == that.draw_match && draw_scene_border == that.draw_scene_border && replace_object == that.replace_object && draw_object_border == that.draw_object_border && @@ -110,7 +122,13 @@ void FindObjConfig::copy_from(FindObjConfig &that) { algorithm = that.algorithm; use_flann = that.use_flann; + mode = that.mode; + aspect = that.aspect; + scale = that.scale; + translate = that.translate; + rotate = that.rotate; draw_keypoints = that.draw_keypoints; + draw_match = that.draw_match; draw_scene_border = that.draw_scene_border; replace_object = that.replace_object; draw_object_border = that.draw_object_border; @@ -155,15 +173,18 @@ FindObjMain::FindObjMain(PluginServer *server) scene_layer = 1; replace_layer = 2; - border_x1 = 0; border_y1 = 0; - border_x2 = 0; border_y2 = 0; - border_x3 = 0; border_y3 = 0; - border_x4 = 0; border_y4 = 0; - - obj_x1 = 0; obj_y1 = 0; - obj_x2 = 0; obj_y2 = 0; - obj_x3 = 0; obj_y3 = 0; - obj_x4 = 0; obj_y4 = 0; + match_x1 = 0; match_y1 = 0; + match_x2 = 0; match_y2 = 0; + match_x3 = 0; match_y3 = 0; + match_x4 = 0; match_y4 = 0; + shape_x1 = 0; shape_y1 = 0; + shape_x2 = 0; shape_y2 = 0; + shape_x3 = 0; shape_y3 = 0; + shape_x4 = 0; shape_y4 = 0; + out_x1 = 0; out_y1 = 0; + out_x2 = 0; out_y2 = 0; + out_x3 = 0; out_y3 = 0; + out_x4 = 0; out_y4 = 0; init_border = 1; } @@ -201,6 +222,11 @@ void FindObjMain::save_data(KeyFrame *keyframe) output.tag.set_title("FINDOBJ"); output.tag.set_property("ALGORITHM", config.algorithm); output.tag.set_property("USE_FLANN", config.use_flann); + output.tag.set_property("MODE", config.mode); + output.tag.set_property("ASPECT", config.aspect); + output.tag.set_property("SCALE", config.scale); + output.tag.set_property("TRANSLATE", config.translate); + output.tag.set_property("ROTATE", config.rotate); output.tag.set_property("DRAG_OBJECT", config.drag_object); output.tag.set_property("OBJECT_X", config.object_x); output.tag.set_property("OBJECT_Y", config.object_y); @@ -219,6 +245,7 @@ void FindObjMain::save_data(KeyFrame *keyframe) output.tag.set_property("REPLACE_DX", config.replace_dx); output.tag.set_property("REPLACE_DY", config.replace_dy); output.tag.set_property("DRAW_KEYPOINTS", config.draw_keypoints); + output.tag.set_property("DRAW_MATCH", config.draw_match); output.tag.set_property("DRAW_SCENE_BORDER", config.draw_scene_border); output.tag.set_property("REPLACE_OBJECT", config.replace_object); output.tag.set_property("DRAW_OBJECT_BORDER", config.draw_object_border); @@ -246,6 +273,11 @@ void FindObjMain::read_data(KeyFrame *keyframe) if( input.tag.title_is("FINDOBJ") ) { config.algorithm = input.tag.get_property("ALGORITHM", config.algorithm); config.use_flann = input.tag.get_property("USE_FLANN", config.use_flann); + config.mode = input.tag.get_property("MODE", config.mode); + config.aspect = input.tag.get_property("ASPECT", config.aspect); + config.scale = input.tag.get_property("SCALE", config.scale); + config.translate = input.tag.get_property("TRANSLATE", config.translate); + config.rotate = input.tag.get_property("ROTATE", config.rotate); config.object_x = input.tag.get_property("OBJECT_X", config.object_x); config.object_y = input.tag.get_property("OBJECT_Y", config.object_y); config.object_w = input.tag.get_property("OBJECT_W", config.object_w); @@ -264,6 +296,7 @@ void FindObjMain::read_data(KeyFrame *keyframe) config.replace_dy = input.tag.get_property("REPLACE_DY", config.replace_dy); config.drag_replace = input.tag.get_property("DRAG_REPLACE", config.drag_replace); config.draw_keypoints = input.tag.get_property("DRAW_KEYPOINTS", config.draw_keypoints); + config.draw_match = input.tag.get_property("DRAW_MATCH", config.draw_match); config.draw_scene_border = input.tag.get_property("DRAW_SCENE_BORDER", config.draw_scene_border); config.replace_object = input.tag.get_property("REPLACE_OBJECT", config.replace_object); config.draw_object_border = input.tag.get_property("DRAW_OBJECT_BORDER", config.draw_object_border); @@ -283,13 +316,45 @@ void FindObjMain::draw_line(VFrame *vframe, int x1, int y1, int x2, int y2) vframe->draw_line(x1, y1, x2, y2); } +void FindObjMain::draw_quad(VFrame *vframe, + int x1, int y1, int x2, int y2, + int x3, int y3, int x4, int y4) +{ + int r = bmin(vframe->get_w(), vframe->get_h()) / 200 + 1; + for( int i=r; --i>0; ) { + draw_line(vframe, x1+i, y1+i, x2, y2); + draw_line(vframe, x1-i, y1-i, x2, y2); + draw_line(vframe, x2+i, y2+i, x3, y3); + draw_line(vframe, x2-i, y2-i, x3, y3); + draw_line(vframe, x3+i, y3+i, x4, y4); + draw_line(vframe, x3-i, y3-i, x4, y4); + draw_line(vframe, x4+i, y4+i, x1, y1); + draw_line(vframe, x4-i, y4-i, x1, y1); + } + draw_line(vframe, x1, y1, x2, y2); + draw_line(vframe, x2, y2, x3, y3); + draw_line(vframe, x3, y3, x4, y4); + draw_line(vframe, x4, y4, x1, y1); +} + +void FindObjMain::draw_point(VFrame *vframe, int x1, int y1) +{ + int r = bmin(vframe->get_w(), vframe->get_h()) / 200 + 1; + for( int i=r; --i>0; ) + draw_circle(vframe, x1, y1, i); +} + void FindObjMain::draw_rect(VFrame *vframe, int x1, int y1, int x2, int y2) { - --x2; --y2; - draw_line(vframe, x1, y1, x2, y1); - draw_line(vframe, x2, y1, x2, y2); - draw_line(vframe, x2, y2, x1, y2); - draw_line(vframe, x1, y2, x1, y1); + int r = bmin(vframe->get_w(), vframe->get_h()) / 200 + 1; + for( int i=r; --i>0; ) { + --x2; --y2; + draw_line(vframe, x1, y1, x2, y1); + draw_line(vframe, x2, y1, x2, y2); + draw_line(vframe, x2, y2, x1, y2); + draw_line(vframe, x1, y2, x1, y1); + ++x1; ++y1; + } } void FindObjMain::draw_circle(VFrame *vframe, int x, int y, int r) @@ -429,12 +494,10 @@ void FindObjMain::set_brisk() } #endif + void FindObjMain::process_match() { if( config.algorithm == NO_ALGORITHM ) return; - if( !config.replace_object && - !config.draw_scene_border && - !config.draw_keypoints ) return; if( detector.empty() ) { switch( config.algorithm ) { @@ -474,24 +537,167 @@ void FindObjMain::process_match() } ptV src, dst; - float obj_x1 = 0, obj_x2 = object_w; - float obj_y1 = 0, obj_y2 = object_h; - src.push_back(Point2f(obj_x1,obj_y1)); - src.push_back(Point2f(obj_x2,obj_y1)); - src.push_back(Point2f(obj_x2,obj_y2)); - src.push_back(Point2f(obj_x1,obj_y2)); + float out_x1 = 0, out_x2 = object_w; + float out_y1 = 0, out_y2 = object_h; + src.push_back(Point2f(out_x1,out_y1)); + src.push_back(Point2f(out_x2,out_y1)); + src.push_back(Point2f(out_x2,out_y2)); + src.push_back(Point2f(out_x1,out_y2)); perspectiveTransform(src, dst, H); - float dx = scene_x + replace_dx; - float dy = scene_y + replace_dy; - border_x1 = dst[0].x + dx; border_y1 = dst[0].y + dy; - border_x2 = dst[1].x + dx; border_y2 = dst[1].y + dy; - border_x3 = dst[2].x + dx; border_y3 = dst[2].y + dy; - border_x4 = dst[3].x + dx; border_y4 = dst[3].y + dy; -//printf("src %f,%f %f,%f %f,%f %f,%f\n", -// src[0].x,src[0].y, src[1].x,src[1].y, src[2].x,src[2].y, src[3].x,src[3].y); -//printf("dst %f,%f %f,%f %f,%f %f,%f\n", -// dst[0].x,dst[0].y, dst[1].x,dst[1].y, dst[2].x,dst[2].y, dst[3].x,dst[3].y); + match_x1 = dst[0].x + scene_x; match_y1 = dst[0].y + scene_y; + match_x2 = dst[1].x + scene_x; match_y2 = dst[1].y + scene_y; + match_x3 = dst[2].x + scene_x; match_y3 = dst[2].y + scene_y; + match_x4 = dst[3].x + scene_x; match_y4 = dst[3].y + scene_y; +} + + +static double area(float x1, float y1, float x2, float y2, + float x3, float y3, float x4, float y4) +{ // quadrelateral area, sign is +ccw,-cw, use abs + double dx1 = x3-x1, dy1 = y3-y1; + double dx2 = x4-x2, dy2 = y4-y2; + return 0.5 * (dx1 * dy2 - dx2 * dy1); +} +static double dist(float x1,float y1, float x2, float y2) +{ + double dx = x2-x1, dy = y2-y1; + return sqrt(dx*dx + dy*dy); +} +static int intersects(double x1, double y1, double x2, double y2, + double x3, double y3, double x4, double y4) +{ + double dx12 = x2 - x1, dy12 = y2 - y1; + double dx34 = x4 - x3, dy34 = y4 - y3; + double d = dx12*dy34 - dx34*dy12; + if( !d ) return 0; // parallel + double dx13 = x3 - x1, dy13 = y3 - y1; + double u = (dx13*dy34 - dx34*dy13) / d; + if( u < 0 || u > 1 ) return 0; + double v = (dx13*dy12 - dx12*dy13) / d; + if( v < 0 || v > 1 ) return 0; + return 1; +} + +/* + * 4---------3 1---------2 + * |0,h w,h| |0,0 w,0| + * | + | | + | + * |0,0 w,0| |0,h w,h| + * 1---------2 1---------2 + * pt locations screen pts + */ +void FindObjMain::reshape() +{ + if( config.mode == MODE_NONE ) return; + const double pi = M_PI; + double x1 = match_x1, y1 = match_y1; + double x2 = match_x2, y2 = match_y2; + double x3 = match_x3, y3 = match_y3; + double x4 = match_x4, y4 = match_y4; + double ia = area(x1,y1, x2,y2, x3,y3, x4,y4); +// centroid + double cx = (x1 + x2 + x3 + x4) / 4; + double cy = (y1 + y2 + y3 + y4) / 4; +// centered + x1 -= cx; x2 -= cx; x3 -= cx; x4 -= cx; + y1 -= cy; y2 -= cy; y3 -= cy; y4 -= cy; +// bowtied + if( intersects(x1,y1, x2,y2, x3,y3, x4,y4) ) { + double x = x2, y = y2; + x2 = x3; y2 = y3; + x3 = x; y3 = y; + } + else if( intersects(x1,y1, x4,y4, x3,y3, x2,y2) ) { + double x = x4, y = y4; + x4 = x3; y4 = y3; + x3 = x; y3 = y; + } + +// rotation, if mode is quad: reverse rotate + double r = 0; + if( (config.mode == MODE_QUADRILATERAL) ^ (config.rotate != 0) ) { +// edge centers + double cx12 = (x1 + x2) / 2, cy12 = (y1 + y2) / 2; + double cx23 = (x2 + x3) / 2, cy23 = (y2 + y3) / 2; + double cx34 = (x3 + x4) / 2, cy34 = (y3 + y4) / 2; + double cx41 = (x4 + x1) / 2, cy41 = (y4 + y1) / 2; + double vx = cx34 - cx12, vy = cy34 - cy12; + double hx = cx23 - cx41, hy = cy23 - cy41; + double v = atan2(vy, vx); + double h = atan2(hy, hx); + r = (h + v - pi/2) / 2; + if( config.mode != MODE_QUADRILATERAL ) r = -r; + } +// diagonal length + double a = dist(x1,y1, x3,y3) / 2; + double b = dist(x2,y2, x4,y4) / 2; + if( config.mode == MODE_SQUARE || + config.mode == MODE_RECTANGLE ) + a = b = (a + b) / 2; +// central angles + double a1 = atan2(y1, x1); + double a2 = atan2(y2, x2); + double a3 = atan2(y3, x3); + double a4 = atan2(y4, x4); +// edge angles + double a12 = a2 - a1, a23 = a3 - a2; + double a34 = a4 - a3, a41 = a1 - a4; + double dt = (a12 - a23 + a34 - a41)/4; +// mirrored + if( ia < 0 ) { ia = -ia; dt = -dt; r = -r; } + switch( config.mode ) { + case MODE_SQUARE: + case MODE_RHOMBUS: + dt = pi/2; + case MODE_RECTANGLE: + case MODE_PARALLELOGRAM: { + double t = -(pi+dt)/2; + x1 = a*cos(t); y1 = a*sin(t); t += dt; + x2 = b*cos(t); y2 = b*sin(t); t += pi - dt; + x3 = a*cos(t); y3 = a*sin(t); t += dt; + x4 = b*cos(t); y4 = b*sin(t); } + case MODE_QUADRILATERAL: + break; + } +// aspect + if( !config.aspect ) { + double cx12 = (x1 + x2) / 2, cy12 = (y1 + y2) / 2; + double cx23 = (x2 + x3) / 2, cy23 = (y2 + y3) / 2; + double cx34 = (x3 + x4) / 2, cy34 = (y3 + y4) / 2; + double cx41 = (x4 + x1) / 2, cy41 = (y4 + y1) / 2; + double iw = dist(cx41,cy41, cx23,cy23); + double ih = dist(cx12,cy12, cx34,cy34); + double ow = object_w, oh = object_h; + double sx = iw && ih ? sqrt((ih*ow)/(iw*oh)) : 1; + double sy = sx ? 1 / sx : 1; + x1 *= sx; x2 *= sx; x3 *= sx; x4 *= sx; + y1 *= sy; y2 *= sy; y3 *= sy; y4 *= sy; + } +// rotation + if( r ) { + double ct = cos(r), st = sin(r), x, y; + x = x1*ct + y1*st; y = y1*ct - x1*st; x1 = x; y1 = y; + x = x2*ct + y2*st; y = y2*ct - x2*st; x2 = x; y2 = y; + x = x3*ct + y3*st; y = y3*ct - x3*st; x3 = x; y3 = y; + x = x4*ct + y4*st; y = y4*ct - x4*st; x4 = x; y4 = y; + } +// scaling + ia = !config.scale ? object_w * object_h : ia; + double oa = abs(area(x1,y1, x2,y2, x3,y3, x4,y4)); + double sf = oa ? sqrt(ia / oa) : 0; + x1 *= sf; x2 *= sf; x3 *= sf; x4 *= sf; + y1 *= sf; y2 *= sf; y3 *= sf; y4 *= sf; +// translation + double ox = !config.translate ? object_x + object_w/2. : cx; + double oy = !config.translate ? object_y + object_h/2. : cy; + x1 += ox; x2 += ox; x3 += ox; x4 += ox; + y1 += oy; y2 += oy; y3 += oy; y4 += oy; + + shape_x1 = x1; shape_y1 = y1; + shape_x2 = x2; shape_y2 = y2; + shape_x3 = x3; shape_y3 = y3; + shape_x4 = x4; shape_y4 = y4; } int FindObjMain::process_buffer(VFrame **frame, int64_t start_position, double frame_rate) @@ -567,21 +773,22 @@ int FindObjMain::process_buffer(VFrame **frame, int64_t start_position, double f scene = frame[scene_layer]; replace = frame[replace_layer]; - border_x1 = obj_x1; border_y1 = obj_y1; - border_x2 = obj_x2; border_y2 = obj_y2; - border_x3 = obj_x3; border_y3 = obj_y3; - border_x4 = obj_x4; border_y4 = obj_y4; + shape_x1 = out_x1; shape_y1 = out_y1; + shape_x2 = out_x2; shape_y2 = out_y2; + shape_x3 = out_x3; shape_y3 = out_y3; + shape_x4 = out_x4; shape_y4 = out_y4; if( scene_w > 0 && scene_h > 0 && object_w > 0 && object_h > 0 ) { process_match(); + reshape(); } - double w0 = init_border ? (init_border=0, 1.) : config.blend/100., w1 = 1. - w0; - obj_x1 = border_x1*w0 + obj_x1*w1; obj_y1 = border_y1*w0 + obj_y1*w1; - obj_x2 = border_x2*w0 + obj_x2*w1; obj_y2 = border_y2*w0 + obj_y2*w1; - obj_x3 = border_x3*w0 + obj_x3*w1; obj_y3 = border_y3*w0 + obj_y3*w1; - obj_x4 = border_x4*w0 + obj_x4*w1; obj_y4 = border_y4*w0 + obj_y4*w1; - + double w0 = init_border ? 1. : config.blend/100., w1 = 1. - w0; + init_border = 0; + out_x1 = shape_x1*w0 + out_x1*w1; out_y1 = shape_y1*w0 + out_y1*w1; + out_x2 = shape_x2*w0 + out_x2*w1; out_y2 = shape_y2*w0 + out_y2*w1; + out_x3 = shape_x3*w0 + out_x3*w1; out_y3 = shape_y3*w0 + out_y3*w1; + out_x4 = shape_x4*w0 + out_x4*w1; out_y4 = shape_y4*w0 + out_y4*w1; // Replace object in the scene layer if( config.replace_object ) { int cpus1 = get_project_smp() + 1; @@ -592,13 +799,12 @@ int FindObjMain::process_buffer(VFrame **frame, int64_t start_position, double f VFrame *temp = new_temp(w, h, scene->get_color_model()); temp->clear_frame(); affine->set_in_viewport(replace_x, replace_y, replace_w, replace_h); - int x1 = obj_x1, x2 = obj_x2, x3 = obj_x3, x4 = obj_x4; - int y1 = obj_y1, y2 = obj_y2, y3 = obj_y3, y4 = obj_y4; - bclamp(x1, 0, w); bclamp(x2, 0, w); bclamp(x3, 0, w); bclamp(x4, 0, w); - bclamp(y1, 0, h); bclamp(y2, 0, h); bclamp(y3, 0, h); bclamp(y4, 0, h); - affine->set_matrix( - replace_x, replace_y, replace_x+replace_w, replace_y+replace_h, - x1,y1, x2,y2, x3,y3, x4,y4); + float ix1 = replace_x, ix2 = ix1 + replace_w; + float iy1 = replace_y, iy2 = iy1 + replace_h; + float dx = replace_dx, dy = replace_dy; + float ox1 = out_x1+dx, ox2 = out_x2+dx, ox3 = out_x3+dx, ox4 = out_x4+dx; + float oy1 = out_y1-dy, oy2 = out_y2-dy, oy3 = out_y3-dy, oy4 = out_y4-dy; + affine->set_matrix(ix1,iy1, ix2,iy2, ox1,oy1, ox2,oy2, ox4,oy4, ox3,oy3); affine->process(temp, replace, 0, AffineEngine::TRANSFORM, 0,0, 100,0, 100,100, 0,100, 1); overlayer->overlay(scene, temp, 0,0, w,h, 0,0, w,h, @@ -606,23 +812,32 @@ int FindObjMain::process_buffer(VFrame **frame, int64_t start_position, double f } + int wh = (w+h)>>8, ss = 1; while( wh>>=1 ) ss<<=1; if( config.draw_scene_border ) { - int wh = (w+h)>>8, ss = 1; while( wh>>=1 ) ss<<=1; - scene->set_pixel_color(WHITE); scene->set_stiple(ss*2); + scene->set_stiple(ss*2); + scene->set_pixel_color(WHITE); draw_rect(scene, scene_x, scene_y, scene_x+scene_w, scene_y+scene_h); } if( config.draw_object_border ) { - int wh = (w+h)>>8, ss = 1; while( wh>>=1 ) ss<<=1; - scene->set_pixel_color(YELLOW); scene->set_stiple(ss*3); + scene->set_stiple(ss*3); + scene->set_pixel_color(YELLOW); draw_rect(scene, object_x, object_y, object_x+object_w, object_y+object_h); } if( config.draw_replace_border ) { - int wh = (w+h)>>8, ss = 1; while( wh>>=1 ) ss<<=1; - scene->set_pixel_color(GREEN); scene->set_stiple(ss*3); + scene->set_stiple(ss*3); + scene->set_pixel_color(GREEN); draw_rect(scene, replace_x, replace_y, replace_x+replace_w, replace_y+replace_h); } + scene->set_stiple(0); if( config.draw_keypoints ) { - scene->set_pixel_color(RED); scene->set_stiple(0); + scene->set_pixel_color(GREEN); + for( int i=0,n=obj_keypts.size(); iset_pixel_color(RED); for( int i=0,n=scn_keypts.size(); iset_pixel_color(BLUE); + draw_quad(scene, match_x1, match_y1, match_x2, match_y2, + match_x3, match_y3, match_x4, match_y4); + scene->set_pixel_color(LTGREEN); + draw_point(scene, match_x1, match_y1); + } if( gui_open() ) { if( config.drag_scene ) {