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::bind_return(sigc::mem_fun(this, &Manipulator::button_press), false));
21 mouse.signal_axis_motion.connect(sigc::bind_return(sigc::mem_fun(this, &Manipulator::axis_motion), false));
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()
52 elev_origin = pointer.y;
55 bool Manipulator::start_extend()
61 const set<Track *> &stracks = selection.get_objects<Track>();
62 for(set<Track *>::const_iterator i=stracks.begin(); (!ok && i!=stracks.end()); ++i)
64 const vector<Track *> &links = (*i)->get_links();
65 for(vector<Track *>::const_iterator j=links.begin(); (!ok && j!=links.end()); ++j)
72 signal_status.emit("No free endpoints");
77 void Manipulator::duplicate()
82 list<Object *> new_objs;
83 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
85 Object *obj = i->object->clone(&designer.get_layout());
86 if(Track *track = dynamic_cast<Track *>(obj))
88 for(list<Object *>::iterator j=new_objs.begin(); j!=new_objs.end(); ++j)
89 if(Track *track2 = dynamic_cast<Track *>(*j))
90 track->snap_to(*track2, true);
92 new_objs.push_back(obj);
95 selection.replace(new_objs.begin(), new_objs.end());
98 void Manipulator::flatten()
107 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
109 z += i->object->get_position().z;
110 if(Track *track = dynamic_cast<Track *>(i->object))
111 z += track->get_slope()/2;
113 z /= static_cast<int>(objects.size());
115 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
117 Vector p = i->object->get_position();
118 i->object->set_position(Vector(p.x, p.y, z));
119 if(Track *track = dynamic_cast<Track *>(i->object))
123 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
129 void Manipulator::even_slope(bool smooth)
134 if(neighbors.size()!=2)
137 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
138 if(Track *track = dynamic_cast<Track *>(i->object))
139 if(track->get_type().get_endpoints().size()!=2)
142 list<Track *> tracks2;
143 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
144 if(Track *track = dynamic_cast<Track *>(i->object))
145 tracks2.push_back(track);
149 list<TrackOrder> order;
150 Track *cur = *neighbors.begin();
151 while(tracks2.size())
154 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
156 const vector<Track *> &links = (*i)->get_links();
163 else if(links[1]==cur)
171 order.push_back(TrackOrder(cur, rev));
172 total_len += cur->get_type().get_total_length();
175 set<Track *>::iterator nb = neighbors.begin();
176 int epi = (*nb)->get_endpoint_by_link(*order.front().track);
177 float start_z = (*nb)->get_snap_node(epi).position.z;
179 epi = (*nb)->get_endpoint_by_link(*order.back().track);
180 float end_z = (*nb)->get_snap_node(epi).position.z;
184 float dir = (end_z>start_z)?1:-1;
186 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
190 float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
191 set_slope(order.front(), start_z, dz);
193 total_len -= order.front().track->get_type().get_total_length();
194 order.erase(order.begin());
196 dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
197 set_slope(order.back(), end_z-dz, dz);
199 total_len -= order.back().track->get_type().get_total_length();
200 order.erase(--order.end());
204 float cur_z = start_z;
205 for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
207 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
208 set_slope(*i, cur_z, dz);
212 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
218 void Manipulator::connect()
220 if(objects.size()!=2)
222 signal_status.emit("Exactly two tracks must be selected");
226 Track *track1 = dynamic_cast<Track *>(objects.front().object);
227 Track *track2 = dynamic_cast<Track *>(objects.back().object);
228 if(!track1 || !track2)
230 signal_status.emit("Exactly two tracks must be selected");
234 float limit = designer.get_layout().get_catalogue().get_gauge()/10;
239 for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
241 if(track1->get_link(i))
244 sn1 = track1->get_snap_node(i);
246 for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
248 if(track2->get_link(j))
251 Snap sn2 = track2->get_snap_node(j);
253 float dz = sn2.position.z-sn1.position.z;
257 float adiff = sn1.rotation+M_PI-sn2.rotation;
265 float c = cos(sn1.rotation);
266 float s = sin(sn1.rotation);
267 float dx = sn2.position.x-sn1.position.x;
268 float dy = sn2.position.y-sn1.position.y;
269 if(abs(dx*s-dy*c)>limit)
285 signal_status.emit("No aligned endpoints found");
289 vector<Track *> trks = create_straight(sn1.position, sn1.rotation, gap, limit);
293 signal_status.emit("No connection possible");
297 trks.front()->snap_to(*track1, true);
298 trks.back()->snap_to(*track2, true);
300 selection.replace(trks.begin(), trks.end());
303 void Manipulator::cancel()
309 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
311 i->object->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
312 i->object->set_rotation(i->rot);
315 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
318 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
320 extend_tracks.clear();
324 signal_done.emit(false);
327 void Manipulator::button_press(unsigned btn)
342 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
343 for(vector<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
344 if(Track *track = dynamic_cast<Track *>(j->object))
345 track->break_link(**i);
348 const set<Track *> <racks = designer.get_layout().get_tracks();
349 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
352 for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
353 ok = (j->object!=*i);
356 for(vector<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
357 if(Track *track = dynamic_cast<Track *>(j->object))
358 track->snap_to(**i, true);
363 selection.replace(extend_tracks.begin(), extend_tracks.end());
364 extend_tracks.clear();
372 signal_done.emit(true);
376 void Manipulator::axis_motion(unsigned axis, float value, float)
382 gpointer = designer.map_pointer_to_ground(pointer);
386 Vector delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
387 Vector offset(center.x+delta.x, center.y+delta.y, center.z);
388 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
390 i->object->set_position(Vector(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
391 i->object->set_rotation(i->rot);
394 const set<Track *> <racks = designer.get_layout().get_tracks();
395 float limit = max(designer.get_layout().get_catalogue().get_gauge(),
396 designer.get_camera_controller().get_view_scale()/100.0f);
397 MObject *snapped = 0;
398 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
401 for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
402 ok = (j->object!=*i);
406 for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && !snapped); ++j)
407 if(Track *track = dynamic_cast<Track *>(j->object))
408 if(track->snap_to(**i, false, limit))
414 float da = snapped->object->get_rotation()-snapped->rot;
417 const Vector &sp = snapped->object->get_position();
418 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
423 Vector dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
424 i->object->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));
425 i->object->set_rotation(i->rot+da);
429 else if(mode==ROTATE)
431 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
432 angle += a-rot_origin;
435 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
437 float c = cos(angle);
438 float s = sin(angle);
439 i->object->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));
440 i->object->set_rotation(angle+i->rot);
443 else if(mode==ELEVATE && axis==1)
445 float dz = pointer.y-elev_origin;
447 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
449 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
450 i->object->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
452 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
455 else if(mode==EXTEND)
460 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
462 Track *track = dynamic_cast<Track *>(i->object);
466 unsigned n_endpoints = track->get_type().get_endpoints().size();
467 for(unsigned j=0; j<n_endpoints; ++j)
469 if(track->get_link(j))
472 Snap sn = track->get_snap_node(j);
473 float c = cos(sn.rotation);
474 float s = sin(sn.rotation);
475 float dx = gpointer.x-sn.position.x;
476 float dy = gpointer.y-sn.position.y;
478 float len = dx*c+dy*s;
490 vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
494 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
496 extend_tracks = trks;
498 map<ArticleNumber, unsigned> counts;
500 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
502 length += (*i)->get_type().get_total_length();
503 ++counts[(*i)->get_type().get_article_number()];
507 for(map<ArticleNumber, unsigned>::const_iterator i=counts.begin(); i!=counts.end(); ++i)
511 detail += format("%dx %s", i->second, i->first);
514 signal_status.emit(format("Extend: %.0fmm (%s)", length*1000, detail));
520 void Manipulator::selection_changed()
526 set<Object *> pending = selection.get_objects();
527 while(!pending.empty())
529 for(set<Object *>::iterator i=pending.begin(); i!=pending.end(); )
531 if((*i)->get_parent() && pending.count((*i)->get_parent()))
535 objects.push_back(*i);
545 void Manipulator::update_objects()
548 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
550 // XXX Use generic bounding box when it is implemented
551 if(Track *track = dynamic_cast<Track *>(i->object))
553 unsigned n_endpoints = track->get_type().get_endpoints().size();
554 for(unsigned j=0; j<n_endpoints; ++j)
556 Vector p = track->get_snap_node(j).position;
557 if(i==objects.begin() && j==0)
561 minp.x = min(minp.x, p.x);
562 maxp.x = max(maxp.x, p.x);
563 minp.y = min(minp.y, p.y);
564 maxp.y = max(maxp.y, p.y);
565 minp.z = min(minp.z, p.z);
571 const Vector &p = i->object->get_position();
572 minp.x = min(minp.x, p.x);
573 maxp.x = max(maxp.x, p.x);
574 minp.y = min(minp.y, p.y);
575 maxp.y = max(maxp.y, p.y);
576 minp.z = min(minp.z, p.z);
580 center = Vector((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
581 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
583 const Vector &p = i->object->get_position();
584 i->pos = Vector(p.x-center.x, p.y-center.y, p.z-center.z);
585 i->rot = i->object->get_rotation();
589 void Manipulator::update_neighbors()
592 for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
594 Track *track = dynamic_cast<Track *>(i->object);
598 const vector<Track *> &links = track->get_links();
599 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
603 if(neighbors.count(*j))
607 for(vector<MObject>::iterator k=objects.begin(); (k!=objects.end() && ok); ++k)
608 ok = (k->object!=*j);
611 neighbors.insert(*j);
616 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
618 const Vector &p = track.track->get_position();
621 track.track->set_position(Vector(p.x, p.y, z+dz));
622 track.track->set_slope(-dz);
626 track.track->set_position(Vector(p.x, p.y, z));
627 track.track->set_slope(dz);
631 vector<Track *> Manipulator::create_straight(const R2C2::Vector &start, float dir, float length, float limit)
633 const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
634 std::map<float, const TrackType *> types_by_length;
635 unsigned preference = 0;
636 for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
638 const vector<TrackPart> &parts = i->second->get_parts();
641 if(parts.front().is_curved() || parts.front().is_dead_end())
644 types_by_length[parts.front().get_length()] = i->second;
645 preference = max(preference, i->second->get_autofit_preference());
648 vector<float> lengths;
653 for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
656 if(i->second->get_autofit_preference()<preference)
658 if((!removed || i->first<removed) && i->first<length+limit)
660 unsigned n = static_cast<unsigned>((length+limit)/i->first);
661 lengths.insert(lengths.end(), n, i->first);
662 length -= n*i->first;
682 length += lengths.back();
683 removed = lengths.back();
687 vector<Track *> trks;
694 for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
696 Track *track = new Track(designer.get_layout(), *get_item(types_by_length, *i));
697 track->set_position(pos);
698 track->set_rotation(dir);
701 track->snap_to(*trks.back(), true);
702 trks.push_back(track);
713 Manipulator::MObject::MObject(Object *o):
715 pos(object->get_position()),
716 rot(object->get_rotation())