X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Fdesigner%2Fmanipulator.cpp;h=23ea138623c42809726c0df07c644ad15ba52f99;hb=1ff06c5bc46a677fa389ef86c6b26664368f1653;hp=798e99f7ebef1c95a47ede24de2daf043480aa6d;hpb=ae0600f7c3df5b6ef46992b1423888dd0e9a5026;p=r2c2.git diff --git a/source/designer/manipulator.cpp b/source/designer/manipulator.cpp index 798e99f..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 #include -#include -#include "3d/layout.h" -#include "libmarklin/tracktype.h" +#include +#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 - -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() @@ -44,9 +34,9 @@ void Manipulator::start_move() if(mode) cancel(); - move_origin=gpointer; + move_origin = gpointer; - mode=MOVE; + mode = MOVE; } void Manipulator::start_rotate() @@ -54,9 +44,9 @@ void Manipulator::start_rotate() if(mode) cancel(); - rot_origin=atan2(gpointer.y-center.y, gpointer.x-center.x); + rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x); - mode=ROTATE; + mode = ROTATE; } void Manipulator::start_elevate() @@ -64,9 +54,17 @@ void Manipulator::start_elevate() if(mode) cancel(); - elev_origin=pointer_y; + elev_origin = pointer_y; - mode=ELEVATE; + mode = ELEVATE; +} + +void Manipulator::start_extend() +{ + if(mode) + cancel(); + + mode = EXTEND; } void Manipulator::duplicate() @@ -77,15 +75,16 @@ void Manipulator::duplicate() list new_tracks; for(vector::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::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i) { - selection->add_track(*i); + selection.add_track(*i); for(list::iterator j=i; j!=new_tracks.end(); ++j) if(j!=i) (*i)->snap_to(**j, true); @@ -99,14 +98,14 @@ void Manipulator::flatten() if(tracks.empty()) return; - float z=0; + float z = 0; for(vector::iterator i=tracks.begin(); i!=tracks.end(); ++i) - z+=i->track->get_position().z+i->track->get_slope()/2; - z/=tracks.size(); + z += i->track->get_position().z+i->track->get_slope()/2; + z /= tracks.size(); for(vector::iterator i=tracks.begin(); i!=tracks.end(); ++i) { - Point p=i->track->get_position(); + Point p = i->track->get_position(); i->track->set_position(Point(p.x, p.y, z)); i->track->set_slope(0); } @@ -114,7 +113,7 @@ void Manipulator::flatten() for(set::iterator i=neighbors.begin(); i!=neighbors.end(); ++i) (*i)->check_slope(); - update_wrap(); + update_tracks(); } void Manipulator::even_slope(bool smooth) @@ -133,84 +132,165 @@ void Manipulator::even_slope(bool smooth) for(vector::iterator i=tracks.begin(); i!=tracks.end(); ++i) tracks2.push_back(i->track); - float total_len=0; + float total_len = 0; list order; - Track *cur=*neighbors.begin(); + Track *cur = *neighbors.begin(); while(tracks2.size()) { - bool rev=false; + bool rev = false; for(list::iterator i=tracks2.begin(); i!=tracks2.end(); ++i) { - const vector &links=(*i)->get_links(); + const vector &links = (*i)->get_links(); if(links[0]==cur) { - cur=*i; + cur = *i; tracks2.erase(i); break; } else if(links[1]==cur) { - cur=*i; - rev=true; + cur = *i; + rev = true; tracks2.erase(i); break; } } order.push_back(TrackOrder(cur, rev)); - total_len+=cur->get_type().get_total_length(); + total_len += cur->get_type().get_total_length(); } - set::iterator nb=neighbors.begin(); - int epi=(*nb)->get_endpoint_by_link(*order.front().track); - float start_z=(*nb)->get_endpoint_position(epi).z; + set::iterator nb = neighbors.begin(); + int epi = (*nb)->get_endpoint_by_link(*order.front().track); + float start_z = (*nb)->get_endpoint_position(epi).z; ++nb; - epi=(*nb)->get_endpoint_by_link(*order.back().track); - float end_z=(*nb)->get_endpoint_position(epi).z; + epi = (*nb)->get_endpoint_by_link(*order.back().track); + float end_z = (*nb)->get_endpoint_position(epi).z; if(smooth) { - float dir=(end_z>start_z)?1:-1; - float cur_slope=0; + float dir = (end_z>start_z)?1:-1; + float cur_slope = 0; while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2) { - cur_slope+=0.025; + cur_slope += 0.025; - float dz=order.front().track->get_type().get_total_length()*dir*cur_slope; + float dz = order.front().track->get_type().get_total_length()*dir*cur_slope; set_slope(order.front(), start_z, dz); - start_z+=dz; - total_len-=order.front().track->get_type().get_total_length(); + start_z += dz; + total_len -= order.front().track->get_type().get_total_length(); order.erase(order.begin()); - dz=order.back().track->get_type().get_total_length()*dir*cur_slope; + dz = order.back().track->get_type().get_total_length()*dir*cur_slope; set_slope(order.back(), end_z-dz, dz); - end_z-=dz; - total_len-=order.back().track->get_type().get_total_length(); + end_z -= dz; + total_len -= order.back().track->get_type().get_total_length(); order.erase(--order.end()); } } - float cur_z=start_z; + float cur_z = start_z; for(list::iterator i=order.begin(); i!=order.end(); ++i) { - float dz=i->track->get_type().get_total_length()*(end_z-start_z)/total_len; + float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len; set_slope(*i, cur_z, dz); - cur_z+=dz; + cur_z += dz; } for(set::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; iget_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; jget_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 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() { if(!mode) return; - mode=NONE; + mode = NONE; - wrap_pos=center; for(vector::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,155 +300,185 @@ void Manipulator::cancel() for(set::iterator i=neighbors.begin(); i!=neighbors.end(); ++i) (*i)->check_slope(); - angle=0; - wrap_rot=0; + for(vector::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i) + delete *i; + extend_tracks.clear(); + + angle = 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=NONE; - update_wrap(); - angle=0; + Mode m = mode; + mode = NONE; + angle = 0; - for(set::iterator i=neighbors.begin(); i!=neighbors.end(); ++i) - for(vector::iterator j=tracks.begin(); j!=tracks.end(); ++j) - j->track->break_link(**i); + if(m!=EXTEND) + { + for(set::iterator i=neighbors.begin(); i!=neighbors.end(); ++i) + for(vector::iterator j=tracks.begin(); j!=tracks.end(); ++j) + j->track->break_link(**i); + } - const set <racks=designer.get_layout()->get_tracks(); + const set <racks = designer.get_layout().get_tracks(); for(set::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i) { - bool ok=true; + bool ok = true; for(vector::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j) - ok=(j->track!=*i); + ok = (j->track!=*i); if(!ok) continue; for(vector::iterator j=tracks.begin(); j!=tracks.end(); ++j) j->track->snap_to(**i, true); } - for(vector::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); + pointer_y = y; + 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::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 <racks=designer.get_layout()->get_tracks(); - MTrack *snapped=0; + const set <racks = 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::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i) { - bool ok=true; + bool ok = true; for(vector::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j) - ok=(j->track!=*i); + ok = (j->track!=*i); if(!ok) continue; for(vector::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j) - if(j->track->snap_to(**i, false)) - snapped=&*j; + if(j->track->snap_to(**i, false, limit)) + snapped = &*j; } if(snapped) { - float da=snapped->track->get_rotation()-snapped->rot; - float c=cos(da); - float s=sin(da); - const Point &sp=snapped->track->get_position(); + float da = snapped->track->get_rotation()-snapped->rot; + float c = cos(da); + float s = sin(da); + const Point &sp = snapped->track->get_position(); for(vector::iterator i=tracks.begin(); i!=tracks.end(); ++i) { if(&*i==snapped) 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); } } } else if(mode==ROTATE) { - float a=atan2(gpointer.y-center.y, gpointer.x-center.x); - angle+=a-rot_origin; - rot_origin=a; + float a = atan2(gpointer.y-center.y, gpointer.x-center.x); + angle += a-rot_origin; + rot_origin = a; - wrap_rot=angle; for(vector::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)); + 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_rotation(angle+i->rot); } } else if(mode==ELEVATE) { - float dz=(y-elev_origin)/1000.; + float dz = (y-elev_origin)/1000.; - ostringstream ss; - ss.precision(3); - ss<<"Elevation: "<::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::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::iterator i=tracks.begin(); i!=tracks.end(); ++i) + { + unsigned n_endpoints = i->track->get_type().get_endpoints().size(); + for(unsigned j=0; jtrack->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::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 trks = create_straight(pos, dir, length, max(length/500, 0.001f)); + + if(!trks.empty()) + { + for(vector::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i) + delete *i; + extend_tracks = trks; -/*** private ***/ + length = 0; + for(vector::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 &stracks=selection->get_tracks(); - tracks.insert(tracks.end(), stracks.begin(), stracks.end()); - } + const set &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::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; atrack->get_type().get_endpoints().size(); + for(unsigned j=0; jtrack->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::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::iterator i=wrap.begin(); i!=wrap.end(); ++i) - { - i->pos.x-=center.x; - i->pos.y-=center.y; + const Point &tp = i->track->get_position(); + i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z); + i->rot = i->track->get_rotation(); } } @@ -452,7 +529,7 @@ void Manipulator::update_neighbors() neighbors.clear(); for(vector::iterator i=tracks.begin(); i!=tracks.end(); ++i) { - const vector &links=i->track->get_links(); + const vector &links = i->track->get_links(); for(vector::const_iterator j=links.begin(); j!=links.end(); ++j) { if(!*j) @@ -460,9 +537,9 @@ void Manipulator::update_neighbors() if(neighbors.count(*j)) continue; - bool ok=true; + bool ok = true; for(vector::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k) - ok=(k->track!=*j); + ok = (k->track!=*j); if(ok) neighbors.insert(*j); @@ -472,7 +549,7 @@ void Manipulator::update_neighbors() void Manipulator::set_slope(TrackOrder &track, float z, float dz) { - const Point &p=track.track->get_position(); + const Point &p = track.track->get_position(); if(track.rev) { track.track->set_position(Point(p.x, p.y, z+dz)); @@ -485,6 +562,92 @@ void Manipulator::set_slope(TrackOrder &track, float z, float dz) } } +vector 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 types_by_length; + unsigned preference = 0; + for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i) + { + const vector &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 lengths; + float removed = 0; + while(length>limit) + { + bool found = false; + for(map::iterator i=types_by_length.end(); i!=types_by_length.begin(); ) + { + --i; + if(i->second->get_autofit_preference()firstfirst((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 trks; + + if(!lengths.empty()) + { + Point pos = start; + float c = cos(dir); + float s = sin(dir); + for(vector::iterator i=lengths.begin(); i!=lengths.end(); ++i) + { + map::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()),