X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Fdesigner%2Fmanipulator.cpp;h=23ea138623c42809726c0df07c644ad15ba52f99;hb=1ff06c5bc46a677fa389ef86c6b26664368f1653;hp=1f21430737c6c2f7d9dcda85869c02cddd1847da;hpb=38fb8d56efde037a71c46a58bda314655e68ab6c;p=r2c2.git

diff --git a/source/designer/manipulator.cpp b/source/designer/manipulator.cpp
index 1f21430..23ea138 100644
--- a/source/designer/manipulator.cpp
+++ b/source/designer/manipulator.cpp
@@ -1,42 +1,32 @@
 /* $Id$
 
-This file is part of the MSP Märklin suite
-Copyright © 2006-2008 Mikkosoft Productions, Mikko Rasa
+This file is part of R²C²
+Copyright © 2006-2010  Mikkosoft Productions, Mikko Rasa
 Distributed under the GPL
 */
 
 #include <algorithm>
 #include <cmath>
-#include <GL/gl.h>
-#include "3d/layout.h"
-#include "libmarklin/tracktype.h"
+#include <msp/strings/formatter.h>
+#include "libr2c2/tracktype.h"
 #include "designer.h"
 #include "manipulator.h"
 #include "selection.h"
 
 using namespace std;
-using namespace Marklin;
+using namespace R2C2;
 using namespace Msp;
 
-#include <iostream>
-
-Manipulator::Manipulator(Designer &d):
+Manipulator::Manipulator(Designer &d, Graphics::EventSource &es, Selection &s):
 	designer(d),
-	selection(0),
-	wrap_rot(0),
+	event_source(es),
+	selection(s),
 	mode(NONE),
 	angle(0)
-{ }
-
-void Manipulator::set_selection(Selection *s)
 {
-	selection_changed_conn.disconnect();
-
-	selection = s;
-	if(selection)
-		selection_changed_conn = selection->signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
-
-	selection_changed();
+	event_source.signal_button_press.connect(sigc::mem_fun(this, &Manipulator::button_press));
+	event_source.signal_pointer_motion.connect(sigc::mem_fun(this, &Manipulator::pointer_motion));
+	selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
 }
 
 void Manipulator::start_move()
@@ -69,6 +59,14 @@ void Manipulator::start_elevate()
 	mode = ELEVATE;
 }
 
+void Manipulator::start_extend()
+{
+	if(mode)
+		cancel();
+
+	mode = EXTEND;
+}
+
 void Manipulator::duplicate()
 {
 	if(mode)
@@ -77,15 +75,16 @@ void Manipulator::duplicate()
 	list<Track *> new_tracks;
 	for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 	{
-		Track *track = i->track->copy();
-		designer.get_layout()->add_track(*track);
+		Track *track = new Track(designer.get_layout(), i->track->get_type());
+		track->set_position(i->track->get_position());
+		track->set_rotation(i->track->get_rotation());
 		new_tracks.push_back(track);
 	}
 
-	selection->clear();
+	selection.clear();
 	for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
 	{
-		selection->add_track(*i);
+		selection.add_track(*i);
 		for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
 			if(j!=i)
 				(*i)->snap_to(**j, true);
@@ -114,7 +113,7 @@ void Manipulator::flatten()
 	for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 		(*i)->check_slope();
 
-	update_wrap();
+	update_tracks();
 }
 
 void Manipulator::even_slope(bool smooth)
@@ -201,7 +200,89 @@ void Manipulator::even_slope(bool smooth)
 	for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 		(*i)->check_slope();
 
-	update_wrap();
+	update_tracks();
+}
+
+void Manipulator::connect()
+{
+	if(tracks.size()!=2)
+	{
+		signal_status.emit("Exactly two tracks must be selected");
+		return;
+	}
+
+	float limit = designer.get_layout().get_catalogue().get_gauge()/10;
+
+	Track *track1 = tracks.front().track;
+	Point pos1;
+	float dir1;
+	Track *track2 = tracks.back().track;
+	bool ok = false;
+	float gap = 0;
+	for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
+	{
+		if(track1->get_link(i))
+			continue;
+
+		pos1 = track1->get_endpoint_position(i);
+		dir1 = track1->get_endpoint_direction(i);
+
+		for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
+		{
+			if(track2->get_link(j))
+				continue;
+
+			Point pos2 = track2->get_endpoint_position(j);
+			float dir2 = track2->get_endpoint_direction(j);
+
+			float dz = pos2.z-pos1.z;
+			if(abs(dz)>0.02)
+				continue;
+
+			float adiff = dir1+M_PI-dir2;
+			while(adiff<-M_PI)
+				adiff += M_PI*2;
+			while(adiff>M_PI)
+				adiff -= M_PI*2;
+			if(abs(adiff)>0.01)
+				continue;
+
+			float c = cos(dir1);
+			float s = sin(dir1);
+			float dx = pos2.x-pos1.x;
+			float dy = pos2.y-pos1.y;
+			if(abs(dx*s-dy*c)>limit)
+				continue;
+
+			gap = dx*c+dy*s;
+			if(gap<0)
+				continue;
+
+			ok = true;
+		}
+
+		if(ok)
+			break;
+	}
+
+	if(!ok)
+	{
+		signal_status.emit("No aligned endpoints found");
+		return;
+	}
+
+	vector<Track *> trks = create_straight(pos1, dir1, gap, limit);
+
+	if(trks.empty())
+	{
+		signal_status.emit("No connection possible");
+		return;
+	}
+
+	trks.front()->snap_to(*track1, true);
+	trks.back()->snap_to(*track2, true);
+
+	selection.replace(trks.begin(), trks.end());
 }
 
 void Manipulator::cancel()
@@ -210,7 +291,6 @@ void Manipulator::cancel()
 		return;
 	mode = NONE;
 
-	wrap_pos = center;
 	for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 	{
 		i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
@@ -220,27 +300,36 @@ void Manipulator::cancel()
 	for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 		(*i)->check_slope();
 
+	for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
+		delete *i;
+	extend_tracks.clear();
+
 	angle = 0;
-	wrap_rot = 0;
 
 	signal_done.emit(false);
 }
 
-void Manipulator::button_press(int, int, float, float, unsigned btn)
+void Manipulator::button_press(int, int, unsigned btn, unsigned)
 {
+	if(!mode)
+		return;
+
 	if(btn==3)
 		cancel();
-	else if(mode)
+	else if(btn==1)
 	{
+		Mode m = mode;
 		mode = NONE;
-		update_wrap();
 		angle = 0;
 
-		for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
-			for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
-				j->track->break_link(**i);
+		if(m!=EXTEND)
+		{
+			for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
+				for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
+					j->track->break_link(**i);
+		}
 
-		const set<Track *> &ltracks = designer.get_layout()->get_tracks();
+		const set<Track *> &ltracks = designer.get_layout().get_tracks();
 		for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
 		{
 			bool ok = true;
@@ -252,32 +341,39 @@ void Manipulator::button_press(int, int, float, float, unsigned btn)
 				j->track->snap_to(**i, true);
 		}
 
-		for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
-			i->rot = i->track->get_rotation();
-
-		update_neighbors();
+		if(m==EXTEND)
+		{
+			selection.replace(extend_tracks.begin(), extend_tracks.end());
+			extend_tracks.clear();
+		}
+		else
+		{
+			update_tracks();
+			update_neighbors();
+		}
 
 		signal_done.emit(true);
 	}
 }
 
-void Manipulator::pointer_motion(int, int y, float gx, float gy)
+void Manipulator::pointer_motion(int x, int y)
 {
 	pointer_y = y;
-	gpointer = Point(gx, gy, 0);
+	gpointer = designer.map_pointer_to_ground(x, event_source.get_height()-1-y);
 
 	if(mode==MOVE)
 	{
 		Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
-
-		wrap_pos = Point(center.x+delta.x, center.y+delta.y, center.z);
+		Point offset(center.x+delta.x, center.y+delta.y, center.z);
 		for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 		{
-			i->track->set_position(Point(wrap_pos.x+i->pos.x, wrap_pos.y+i->pos.y, wrap_pos.z+i->pos.z));
+			i->track->set_position(Point(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
 			i->track->set_rotation(i->rot);
 		}
 
-		const set<Track *> &ltracks = designer.get_layout()->get_tracks();
+		const set<Track *> &ltracks = designer.get_layout().get_tracks();
+		float limit = max(designer.get_layout().get_catalogue().get_gauge(),
+			designer.get_camera_controller().get_view_scale()*5/event_source.get_height());
 		MTrack *snapped = 0;
 		for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
 		{
@@ -287,7 +383,7 @@ void Manipulator::pointer_motion(int, int y, float gx, float gy)
 			if(!ok) continue;
 
 			for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
-				if(j->track->snap_to(**i, false))
+				if(j->track->snap_to(**i, false, limit))
 					snapped = &*j;
 		}
 
@@ -303,7 +399,7 @@ void Manipulator::pointer_motion(int, int y, float gx, float gy)
 					continue;
 
 				Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
-				i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z));
+				i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z+i->pos.z-snapped->pos.z));
 				i->track->set_rotation(i->rot+da);
 			}
 		}
@@ -314,12 +410,11 @@ void Manipulator::pointer_motion(int, int y, float gx, float gy)
 		angle += a-rot_origin;
 		rot_origin = a;
 
-		wrap_rot = angle;
 		for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 		{
 			float c = cos(angle);
 			float s = sin(angle);
-			i->track->set_position(Point(center.x+c*i->pos.x-s*i->pos.y, center.y+s*i->pos.x+c*i->pos.y, center.z*i->pos.z));
+			i->track->set_position(Point(center.x+c*i->pos.x-s*i->pos.y, center.y+s*i->pos.x+c*i->pos.y, center.z+i->pos.z));
 			i->track->set_rotation(angle+i->rot);
 		}
 	}
@@ -327,48 +422,63 @@ void Manipulator::pointer_motion(int, int y, float gx, float gy)
 	{
 		float dz = (y-elev_origin)/1000.;
 
-		ostringstream ss;
-		ss.precision(3);
-		ss<<"Elevation: "<<dz*1000<<"mm ("<<(center.z+dz)*1000<<"mm)";
-		signal_status.emit(ss.str());
+		signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
 
-		wrap_pos.z = center.z+dz;
 		for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 			i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
 
 		for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 			(*i)->check_slope();
 	}
-}
+	else if(mode==EXTEND)
+	{
+		Point pos;
+		float dir = 0;
+		float length = 0;
+		for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
+		{
+			unsigned n_endpoints = i->track->get_type().get_endpoints().size();
+			for(unsigned j=0; j<n_endpoints; ++j)
+			{
+				if(i->track->get_link(j))
+					continue;
 
-void Manipulator::render()
-{
-	glPushMatrix();
-	glTranslatef(wrap_pos.x, wrap_pos.y, wrap_pos.z);
-	glRotatef(wrap_rot*180/M_PI, 0, 0, 1);
+				Point ep_pos = i->track->get_endpoint_position(j);
+				float ep_dir = i->track->get_endpoint_direction(j);
+				float c = cos(ep_dir);
+				float s = sin(ep_dir);
+				float dx = gpointer.x-ep_pos.x;
+				float dy = gpointer.y-ep_pos.y;
 
-	glLineWidth(2);
-	glColor4f(0, 1, 0, 0.5);
-	for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
-	{
-		glPushMatrix();
-		glTranslatef(i->pos.x, i->pos.y, i->pos.z);
-		glRotatef(i->rot*180/M_PI, 0, 0, 1);
-
-		glBegin(GL_LINE_LOOP);
-		glVertex2f(-i->width/2, -i->height/2);
-		glVertex2f(i->width/2, -i->height/2);
-		glVertex2f(i->width/2, i->height/2);
-		glVertex2f(-i->width/2, i->height/2);
-		glEnd();
-
-		glPopMatrix();
-	}
+				float len = dx*c+dy*s;
+				if(len<length)
+					continue;
 
-	glPopMatrix();
-}
+				pos = ep_pos;
+				dir = ep_dir;
+				length = len;
+			}
+		}
+
+		if(length)
+		{
+			vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
+
+			if(!trks.empty())
+			{
+				for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
+					delete *i;
+				extend_tracks = trks;
 
-/*** private ***/
+				length = 0;
+				for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
+					length += (*i)->get_type().get_total_length();
+
+				signal_status.emit(format("Extend: %.0fmm", length*1000));
+			}
+		}
+	}
+}
 
 void Manipulator::selection_changed()
 {
@@ -376,74 +486,41 @@ void Manipulator::selection_changed()
 		cancel();
 
 	tracks.clear();
-	if(selection)
-	{
-		const set<Track *> &stracks = selection->get_tracks();
-		tracks.insert(tracks.end(), stracks.begin(), stracks.end());
-	}
+	const set<Track *> &stracks = selection.get_tracks();
+	tracks.insert(tracks.end(), stracks.begin(), stracks.end());
 
 	update_neighbors();
-	update_wrap();
+	update_tracks();
 }
 
-void Manipulator::update_wrap()
+void Manipulator::update_tracks()
 {
-	wrap.clear();
-	float min_x = 0, max_x = 0;
-	float min_y = 0, max_y = 0;
+	Point minp, maxp;
 	for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 	{
-		Track3D &t3d = designer.get_layout_3d()->get_track(*i->track);
-
-		TrackWrap tw;
-		float min_area = 100;
-		for(float a=0; a<M_PI; a+=0.01)
+		unsigned n_endpoints = i->track->get_type().get_endpoints().size();
+		for(unsigned j=0; j<n_endpoints; ++j)
 		{
-			Point minp, maxp;
-			t3d.get_bounds(a, minp, maxp);
-			float area = (maxp.x-minp.x)*(maxp.y-minp.y);
-			if(area<min_area)
+			Point p = i->track->get_endpoint_position(j);
+			if(i==tracks.begin() && j==0)
+				minp = maxp = p;
+			else
 			{
-				float c = cos(a);
-				float s = sin(a);
-				float x = (minp.x+maxp.x)/2;
-				float y = (minp.y+maxp.y)/2;
-				tw.pos = Point(c*x-s*y, s*x+c*y, (minp.z+maxp.z)/2);
-				tw.rot = a;
-				tw.width = maxp.x-minp.x+0.01;
-				tw.height = maxp.y-minp.y+0.01;
-
-				min_area = area;
+				minp.x = min(minp.x, p.x);
+				maxp.x = max(maxp.x, p.x);
+				minp.y = min(minp.y, p.y);
+				maxp.y = max(maxp.y, p.y);
+				minp.z = min(minp.z, p.z);
 			}
 		}
-
-		if(i==tracks.begin())
-		{
-			min_x = max_x = tw.pos.x;
-			min_y = max_y = tw.pos.y;
-		}
-		else
-		{
-			min_x = min(min_x, tw.pos.x);
-			max_x = max(max_x, tw.pos.x);
-			min_y = min(min_y, tw.pos.y);
-			max_y = max(max_y, tw.pos.y);
-		}
-		wrap.push_back(tw);
 	}
 
-	center = Point((min_x+max_x)/2, (min_y+max_y)/2, 0);
-	wrap_pos = center;
-	wrap_rot = 0;
+	center = Point((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
 	for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 	{
 		const Point &tp = i->track->get_position();
-		i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z);
-	}
-	for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
-	{
-		i->pos.x -= center.x;
-		i->pos.y -= center.y;
+		i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z);
+		i->rot = i->track->get_rotation();
 	}
 }
 
@@ -485,6 +562,92 @@ void Manipulator::set_slope(TrackOrder &track, float z, float dz)
 	}
 }
 
+vector<Track *> Manipulator::create_straight(const R2C2::Point &start, float dir, float length, float limit)
+{
+	const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
+	std::map<float, const TrackType *> types_by_length;
+	unsigned preference = 0;
+	for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
+	{
+		const vector<TrackPart> &parts = i->second->get_parts();
+		if(parts.size()!=1)
+			continue;
+		if(parts.front().is_curved() || parts.front().is_dead_end())
+			continue;
+
+		types_by_length[parts.front().get_length()] = i->second;
+		preference = max(preference, i->second->get_autofit_preference());
+	}
+
+	vector<float> lengths;
+	float removed = 0;
+	while(length>limit)
+	{
+		bool found = false;
+		for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
+		{
+			--i;
+			if(i->second->get_autofit_preference()<preference)
+				continue;
+			if((!removed || i->first<removed) && i->first<length+limit)
+			{
+				unsigned n = static_cast<unsigned>((length+limit)/i->first);
+				lengths.insert(lengths.end(), n, i->first);
+				length -= n*i->first;
+				found = true;
+				break;
+			}
+		}
+
+		if(found)
+			continue;
+
+		if(lengths.empty())
+		{
+			if(preference>0)
+			{
+				--preference;
+				removed = 0;
+				continue;
+			}
+			break;
+		}
+
+		length += lengths.back();
+		removed = lengths.back();
+		lengths.pop_back();
+	}
+
+	vector<Track *> trks;
+
+	if(!lengths.empty())
+	{
+		Point pos = start;
+		float c = cos(dir);
+		float s = sin(dir);
+		for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
+		{
+			map<float, const TrackType *>::iterator j = types_by_length.find(*i);
+			if(j==types_by_length.end())
+				throw LogicError("Internal error");
+
+			Track *track = new Track(designer.get_layout(), *j->second);
+			track->set_position(pos);
+			track->set_rotation(dir);
+
+			if(!trks.empty())
+				track->snap_to(*trks.back(), true);
+			trks.push_back(track);
+
+			pos.x += c**i;
+			pos.y += s**i;
+		}
+	}
+
+	return trks;
+}
+
+
 Manipulator::MTrack::MTrack(Track *t):
 	track(t),
 	pos(track->get_position()),