- if(track2->get_link(j))
- continue;
-
- Vector 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()
-{
- if(!mode)
- return;
- mode = NONE;
-
- for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
- {
- i->track->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
- i->track->set_rotation(i->rot);
- }
-
- 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;
-
- signal_done.emit(false);
-}
-
-void Manipulator::button_press(int, int, unsigned btn, unsigned)
-{
- if(!mode)
- return;
-
- if(btn==3)
- cancel();
- else if(btn==1)
- {
- Mode m = mode;
- mode = NONE;
- angle = 0;
-
- 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 *> <racks = designer.get_layout().get_tracks();
- for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
- {
- bool ok = true;
- for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
- ok = (j->track!=*i);
- if(!ok) continue;
-
- for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
- j->track->snap_to(**i, true);
- }
-
- 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 x, int y)
-{
- pointer_y = event_source.get_height()-1-y;
- gpointer = designer.map_pointer_to_ground(x, pointer_y);
-
- if(mode==MOVE)
- {
- Vector delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
- Vector 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(Vector(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
- i->track->set_rotation(i->rot);
- }
-
- const set<Track *> <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<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
- {
- bool ok = true;
- for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
- ok = (j->track!=*i);
- if(!ok) continue;
-
- for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !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 Vector &sp = snapped->track->get_position();
- for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
- {
- if(&*i==snapped)
- continue;
-
- Vector dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
- i->track->set_position(Vector(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;
-
- for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
- {
- float c = cos(angle);
- float s = sin(angle);
- i->track->set_position(Vector(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 = (pointer_y-elev_origin)/1000.;
-
- signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
-
- for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
- i->track->set_position(Vector(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)
- {
- Vector 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;
-
- Vector 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;
-
- float len = dx*c+dy*s;
- if(len<length)
- continue;
-
- 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())