3 #include <msp/strings/format.h>
4 #include "libr2c2/tracktype.h"
6 #include "manipulator.h"
13 Manipulator::Manipulator(Designer &d, Input::Mouse &m, Selection &s):
20 mouse.signal_button_press.connect(sigc::mem_fun(this, &Manipulator::button_press));
21 mouse.signal_axis_motion.connect(sigc::mem_fun(this, &Manipulator::axis_motion));
22 selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
25 void Manipulator::start_move()
30 move_origin = gpointer;
35 void Manipulator::start_rotate()
40 rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
45 void Manipulator::start_elevate()
53 bool Manipulator::start_extend()
59 const set<Track *> &stracks = selection.get_tracks();
60 for(set<Track *>::const_iterator i=stracks.begin(); (!ok && i!=stracks.end()); ++i)
62 const vector<Track *> &links = (*i)->get_links();
63 for(vector<Track *>::const_iterator j=links.begin(); (!ok && j!=links.end()); ++j)
70 signal_status.emit("No free endpoints");
75 void Manipulator::duplicate()
80 list<Track *> new_tracks;
81 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
83 Track *track = new Track(designer.get_layout(), i->track->get_type());
84 track->set_position(i->track->get_position());
85 track->set_rotation(i->track->get_rotation());
86 new_tracks.push_back(track);
90 for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
92 selection.add_track(*i);
93 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
95 (*i)->snap_to(**j, true);
99 void Manipulator::flatten()
104 if(tracks.empty()) return;
107 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
108 z += i->track->get_position().z+i->track->get_slope()/2;
111 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
113 Vector p = i->track->get_position();
114 i->track->set_position(Vector(p.x, p.y, z));
115 i->track->set_slope(0);
118 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
124 void Manipulator::even_slope(bool smooth)
129 if(neighbors.size()!=2)
132 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
133 if(i->track->get_type().get_endpoints().size()!=2)
136 list<Track *> tracks2;
137 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
138 tracks2.push_back(i->track);
142 list<TrackOrder> order;
143 Track *cur = *neighbors.begin();
144 while(tracks2.size())
147 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
149 const vector<Track *> &links = (*i)->get_links();
156 else if(links[1]==cur)
164 order.push_back(TrackOrder(cur, rev));
165 total_len += cur->get_type().get_total_length();
168 set<Track *>::iterator nb = neighbors.begin();
169 int epi = (*nb)->get_endpoint_by_link(*order.front().track);
170 float start_z = (*nb)->get_endpoint_position(epi).z;
172 epi = (*nb)->get_endpoint_by_link(*order.back().track);
173 float end_z = (*nb)->get_endpoint_position(epi).z;
177 float dir = (end_z>start_z)?1:-1;
179 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
183 float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
184 set_slope(order.front(), start_z, dz);
186 total_len -= order.front().track->get_type().get_total_length();
187 order.erase(order.begin());
189 dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
190 set_slope(order.back(), end_z-dz, dz);
192 total_len -= order.back().track->get_type().get_total_length();
193 order.erase(--order.end());
197 float cur_z = start_z;
198 for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
200 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
201 set_slope(*i, cur_z, dz);
205 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
211 void Manipulator::connect()
215 signal_status.emit("Exactly two tracks must be selected");
219 float limit = designer.get_layout().get_catalogue().get_gauge()/10;
221 Track *track1 = tracks.front().track;
224 Track *track2 = tracks.back().track;
227 for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
229 if(track1->get_link(i))
232 pos1 = track1->get_endpoint_position(i);
233 dir1 = track1->get_endpoint_direction(i);
235 for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
237 if(track2->get_link(j))
240 Vector pos2 = track2->get_endpoint_position(j);
241 float dir2 = track2->get_endpoint_direction(j);
243 float dz = pos2.z-pos1.z;
247 float adiff = dir1+M_PI-dir2;
257 float dx = pos2.x-pos1.x;
258 float dy = pos2.y-pos1.y;
259 if(abs(dx*s-dy*c)>limit)
275 signal_status.emit("No aligned endpoints found");
279 vector<Track *> trks = create_straight(pos1, dir1, gap, limit);
283 signal_status.emit("No connection possible");
287 trks.front()->snap_to(*track1, true);
288 trks.back()->snap_to(*track2, true);
290 selection.replace(trks.begin(), trks.end());
293 void Manipulator::cancel()
299 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
301 i->track->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
302 i->track->set_rotation(i->rot);
305 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
308 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
310 extend_tracks.clear();
314 signal_done.emit(false);
317 void Manipulator::button_press(unsigned btn)
332 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
333 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
334 j->track->break_link(**i);
337 const set<Track *> <racks = designer.get_layout().get_tracks();
338 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
341 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
345 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
346 j->track->snap_to(**i, true);
351 selection.replace(extend_tracks.begin(), extend_tracks.end());
352 extend_tracks.clear();
360 signal_done.emit(true);
364 void Manipulator::axis_motion(unsigned axis, float value, float change)
370 gpointer = designer.map_pointer_to_ground(pointer);
374 Vector delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
375 Vector offset(center.x+delta.x, center.y+delta.y, center.z);
376 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
378 i->track->set_position(Vector(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
379 i->track->set_rotation(i->rot);
382 const set<Track *> <racks = designer.get_layout().get_tracks();
383 float limit = max(designer.get_layout().get_catalogue().get_gauge(),
384 designer.get_camera_controller().get_view_scale()/100.0f);
386 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
389 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
393 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
394 if(j->track->snap_to(**i, false, limit))
400 float da = snapped->track->get_rotation()-snapped->rot;
403 const Vector &sp = snapped->track->get_position();
404 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
409 Vector dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
410 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));
411 i->track->set_rotation(i->rot+da);
415 else if(mode==ROTATE)
417 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
418 angle += a-rot_origin;
421 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
423 float c = cos(angle);
424 float s = sin(angle);
425 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));
426 i->track->set_rotation(angle+i->rot);
429 else if(mode==ELEVATE && axis==1)
433 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
435 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
436 i->track->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
438 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
441 else if(mode==EXTEND)
446 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
448 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
449 for(unsigned j=0; j<n_endpoints; ++j)
451 if(i->track->get_link(j))
454 Vector ep_pos = i->track->get_endpoint_position(j);
455 float ep_dir = i->track->get_endpoint_direction(j);
456 float c = cos(ep_dir);
457 float s = sin(ep_dir);
458 float dx = gpointer.x-ep_pos.x;
459 float dy = gpointer.y-ep_pos.y;
461 float len = dx*c+dy*s;
473 vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
477 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
479 extend_tracks = trks;
481 map<ArticleNumber, unsigned> counts;
483 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
485 length += (*i)->get_type().get_total_length();
486 ++counts[(*i)->get_type().get_article_number()];
490 for(map<ArticleNumber, unsigned>::const_iterator i=counts.begin(); i!=counts.end(); ++i)
494 detail += format("%dx %s", i->second, i->first);
497 signal_status.emit(format("Extend: %.0fmm (%s)", length*1000, detail));
503 void Manipulator::selection_changed()
509 const set<Track *> &stracks = selection.get_tracks();
510 tracks.insert(tracks.end(), stracks.begin(), stracks.end());
516 void Manipulator::update_tracks()
519 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
521 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
522 for(unsigned j=0; j<n_endpoints; ++j)
524 Vector p = i->track->get_endpoint_position(j);
525 if(i==tracks.begin() && j==0)
529 minp.x = min(minp.x, p.x);
530 maxp.x = max(maxp.x, p.x);
531 minp.y = min(minp.y, p.y);
532 maxp.y = max(maxp.y, p.y);
533 minp.z = min(minp.z, p.z);
538 center = Vector((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
539 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
541 const Vector &tp = i->track->get_position();
542 i->pos = Vector(tp.x-center.x, tp.y-center.y, tp.z-center.z);
543 i->rot = i->track->get_rotation();
547 void Manipulator::update_neighbors()
550 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
552 const vector<Track *> &links = i->track->get_links();
553 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
557 if(neighbors.count(*j))
561 for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
565 neighbors.insert(*j);
570 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
572 const Vector &p = track.track->get_position();
575 track.track->set_position(Vector(p.x, p.y, z+dz));
576 track.track->set_slope(-dz);
580 track.track->set_position(Vector(p.x, p.y, z));
581 track.track->set_slope(dz);
585 vector<Track *> Manipulator::create_straight(const R2C2::Vector &start, float dir, float length, float limit)
587 const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
588 std::map<float, const TrackType *> types_by_length;
589 unsigned preference = 0;
590 for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
592 const vector<TrackPart> &parts = i->second->get_parts();
595 if(parts.front().is_curved() || parts.front().is_dead_end())
598 types_by_length[parts.front().get_length()] = i->second;
599 preference = max(preference, i->second->get_autofit_preference());
602 vector<float> lengths;
607 for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
610 if(i->second->get_autofit_preference()<preference)
612 if((!removed || i->first<removed) && i->first<length+limit)
614 unsigned n = static_cast<unsigned>((length+limit)/i->first);
615 lengths.insert(lengths.end(), n, i->first);
616 length -= n*i->first;
636 length += lengths.back();
637 removed = lengths.back();
641 vector<Track *> trks;
648 for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
650 Track *track = new Track(designer.get_layout(), *get_item(types_by_length, *i));
651 track->set_position(pos);
652 track->set_rotation(dir);
655 track->snap_to(*trks.back(), true);
656 trks.push_back(track);
667 Manipulator::MTrack::MTrack(Track *t):
669 pos(track->get_position()),
670 rot(track->get_rotation())