3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
10 #include <msp/strings/formatter.h>
11 #include "libmarklin/tracktype.h"
13 #include "manipulator.h"
14 #include "selection.h"
17 using namespace Marklin;
20 Manipulator::Manipulator(Designer &d, Selection &s):
26 selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
29 void Manipulator::start_move()
34 move_origin = gpointer;
39 void Manipulator::start_rotate()
44 rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
49 void Manipulator::start_elevate()
54 elev_origin = pointer_y;
59 void Manipulator::start_extend()
67 void Manipulator::duplicate()
72 list<Track *> new_tracks;
73 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
75 Track *track = new Track(designer.get_layout(), i->track->get_type());
76 track->set_position(i->track->get_position());
77 track->set_rotation(i->track->get_rotation());
78 new_tracks.push_back(track);
82 for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
84 selection.add_track(*i);
85 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
87 (*i)->snap_to(**j, true);
91 void Manipulator::flatten()
96 if(tracks.empty()) return;
99 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
100 z += i->track->get_position().z+i->track->get_slope()/2;
103 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
105 Point p = i->track->get_position();
106 i->track->set_position(Point(p.x, p.y, z));
107 i->track->set_slope(0);
110 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
116 void Manipulator::even_slope(bool smooth)
121 if(neighbors.size()!=2)
124 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
125 if(i->track->get_type().get_endpoints().size()!=2)
128 list<Track *> tracks2;
129 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
130 tracks2.push_back(i->track);
134 list<TrackOrder> order;
135 Track *cur = *neighbors.begin();
136 while(tracks2.size())
139 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
141 const vector<Track *> &links = (*i)->get_links();
148 else if(links[1]==cur)
156 order.push_back(TrackOrder(cur, rev));
157 total_len += cur->get_type().get_total_length();
160 set<Track *>::iterator nb = neighbors.begin();
161 int epi = (*nb)->get_endpoint_by_link(*order.front().track);
162 float start_z = (*nb)->get_endpoint_position(epi).z;
164 epi = (*nb)->get_endpoint_by_link(*order.back().track);
165 float end_z = (*nb)->get_endpoint_position(epi).z;
169 float dir = (end_z>start_z)?1:-1;
171 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
175 float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
176 set_slope(order.front(), start_z, dz);
178 total_len -= order.front().track->get_type().get_total_length();
179 order.erase(order.begin());
181 dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
182 set_slope(order.back(), end_z-dz, dz);
184 total_len -= order.back().track->get_type().get_total_length();
185 order.erase(--order.end());
189 float cur_z = start_z;
190 for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
192 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
193 set_slope(*i, cur_z, dz);
197 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
203 void Manipulator::connect()
207 signal_status.emit("Exactly two tracks must be selected");
213 Track *track1 = tracks.front().track;
216 Track *track2 = tracks.back().track;
219 for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
221 if(track1->get_link(i))
224 pos1 = track1->get_endpoint_position(i);
225 dir1 = track1->get_endpoint_direction(i);
227 for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
229 if(track2->get_link(j))
232 Point pos2 = track2->get_endpoint_position(j);
233 float dir2 = track2->get_endpoint_direction(j);
235 float dz = pos2.z-pos1.z;
239 float adiff = dir1+M_PI-dir2;
249 float dx = pos2.x-pos1.x;
250 float dy = pos2.y-pos1.y;
251 if(abs(dx*s-dy*c)>limit)
267 signal_status.emit("No aligned endpoints found");
271 vector<Track *> trks = create_straight(pos1, dir1, gap, limit);
275 signal_status.emit("No connection possible");
279 trks.front()->snap_to(*track1, true);
280 trks.back()->snap_to(*track2, true);
282 selection.replace(trks.begin(), trks.end());
285 void Manipulator::cancel()
291 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
293 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
294 i->track->set_rotation(i->rot);
297 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
300 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
302 extend_tracks.clear();
306 signal_done.emit(false);
309 void Manipulator::button_press(int, int, float, float, unsigned btn)
313 else if(btn==1 && mode)
321 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
322 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
323 j->track->break_link(**i);
326 const set<Track *> <racks = designer.get_layout().get_tracks();
327 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
330 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
334 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
335 j->track->snap_to(**i, true);
340 selection.replace(extend_tracks.begin(), extend_tracks.end());
341 extend_tracks.clear();
349 signal_done.emit(true);
353 void Manipulator::pointer_motion(int, int y, float gx, float gy)
356 gpointer = Point(gx, gy, 0);
360 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
361 Point offset(center.x+delta.x, center.y+delta.y, center.z);
362 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
364 i->track->set_position(Point(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
365 i->track->set_rotation(i->rot);
368 const set<Track *> <racks = designer.get_layout().get_tracks();
370 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
373 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
377 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
378 if(j->track->snap_to(**i, false))
384 float da = snapped->track->get_rotation()-snapped->rot;
387 const Point &sp = snapped->track->get_position();
388 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
393 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
394 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));
395 i->track->set_rotation(i->rot+da);
399 else if(mode==ROTATE)
401 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
402 angle += a-rot_origin;
405 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
407 float c = cos(angle);
408 float s = sin(angle);
409 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));
410 i->track->set_rotation(angle+i->rot);
413 else if(mode==ELEVATE)
415 float dz = (y-elev_origin)/1000.;
417 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
419 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
420 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
422 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
425 else if(mode==EXTEND)
430 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
432 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
433 for(unsigned j=0; j<n_endpoints; ++j)
435 if(i->track->get_link(j))
438 Point ep_pos = i->track->get_endpoint_position(j);
439 float ep_dir = i->track->get_endpoint_direction(j);
440 float c = cos(ep_dir);
441 float s = sin(ep_dir);
442 float dx = gx-ep_pos.x;
443 float dy = gy-ep_pos.y;
445 float len = dx*c+dy*s;
457 vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
461 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
463 extend_tracks = trks;
466 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
467 length += (*i)->get_type().get_total_length();
469 signal_status.emit(format("Extend: %.0fmm", length*1000));
475 void Manipulator::selection_changed()
481 const set<Track *> &stracks = selection.get_tracks();
482 tracks.insert(tracks.end(), stracks.begin(), stracks.end());
488 void Manipulator::update_tracks()
491 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
493 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
494 for(unsigned j=0; j<n_endpoints; ++j)
496 Point p = i->track->get_endpoint_position(j);
497 if(i==tracks.begin() && j==0)
501 minp.x = min(minp.x, p.x);
502 maxp.x = max(maxp.x, p.x);
503 minp.y = min(minp.y, p.y);
504 maxp.y = max(maxp.y, p.y);
505 minp.z = min(minp.z, p.z);
510 center = Point((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
511 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
513 const Point &tp = i->track->get_position();
514 i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z);
515 i->rot = i->track->get_rotation();
519 void Manipulator::update_neighbors()
522 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
524 const vector<Track *> &links = i->track->get_links();
525 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
529 if(neighbors.count(*j))
533 for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
537 neighbors.insert(*j);
542 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
544 const Point &p = track.track->get_position();
547 track.track->set_position(Point(p.x, p.y, z+dz));
548 track.track->set_slope(-dz);
552 track.track->set_position(Point(p.x, p.y, z));
553 track.track->set_slope(dz);
557 vector<Track *> Manipulator::create_straight(const Marklin::Point &start, float dir, float length, float limit)
559 const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
560 std::map<float, const TrackType *> types_by_length;
561 unsigned preference = 0;
562 for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
564 const vector<TrackPart> &parts = i->second->get_parts();
567 if(parts.front().is_curved() || parts.front().is_dead_end())
570 types_by_length[parts.front().get_length()] = i->second;
571 preference = max(preference, i->second->get_autofit_preference());
574 vector<float> lengths;
579 for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
582 if(i->second->get_autofit_preference()<preference)
584 if((!removed || i->first<removed) && i->first<length+limit)
586 unsigned n = static_cast<unsigned>((length+limit)/i->first);
587 lengths.insert(lengths.end(), n, i->first);
588 length -= n*i->first;
608 length += lengths.back();
609 removed = lengths.back();
613 vector<Track *> trks;
620 for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
622 map<float, const TrackType *>::iterator j = types_by_length.find(*i);
623 if(j==types_by_length.end())
624 throw LogicError("Internal error");
626 Track *track = new Track(designer.get_layout(), *j->second);
627 track->set_position(pos);
628 track->set_rotation(dir);
631 track->snap_to(*trks.back(), true);
632 trks.push_back(track);
643 Manipulator::MTrack::MTrack(Track *t):
645 pos(track->get_position()),
646 rot(track->get_rotation())