]> git.tdb.fi Git - r2c2.git/blobdiff - source/designer/manipulator.cpp
Don't crash if a train has no router
[r2c2.git] / source / designer / manipulator.cpp
index 5bf02e9760ab2765cc01e0842c111b760b89b429..77269228b88567f92dc9575dd1a49ce7c955f98a 100644 (file)
@@ -10,508 +10,10 @@ using namespace std;
 using namespace R2C2;
 using namespace Msp;
 
-Manipulator::Manipulator(Designer &d, Input::Mouse &m, Selection &s):
-       designer(d),
-       mouse(m),
-       selection(s),
-       mode(NONE),
-       angle(0)
+Manipulator::Manipulator(Designer &d, Input::Keyboard &k, Input::Mouse &m, const set<Object *> &objs):
+       Tool(d, k, m)
 {
-       mouse.signal_button_press.connect(sigc::bind_return(sigc::mem_fun(this, &Manipulator::button_press), false));
-       mouse.signal_axis_motion.connect(sigc::bind_return(sigc::mem_fun(this, &Manipulator::axis_motion), false));
-       selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
-}
-
-void Manipulator::start_move()
-{
-       if(mode)
-               cancel();
-
-       move_origin = gpointer;
-
-       mode = MOVE;
-}
-
-void Manipulator::start_rotate()
-{
-       if(mode)
-               cancel();
-
-       rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
-
-       mode = ROTATE;
-}
-
-void Manipulator::start_elevate()
-{
-       if(mode)
-               cancel();
-
-       mode = ELEVATE;
-
-       elev_origin = pointer.y;
-}
-
-bool Manipulator::start_extend()
-{
-       if(mode)
-               cancel();
-
-       bool ok = false;
-       const set<Track *> &stracks = selection.get_objects<Track>();
-       for(set<Track *>::const_iterator i=stracks.begin(); (!ok && i!=stracks.end()); ++i)
-       {
-               const vector<Track *> &links = (*i)->get_links();
-               for(vector<Track *>::const_iterator j=links.begin(); (!ok && j!=links.end()); ++j)
-                       ok = !*j;
-       }
-
-       if(ok)
-               mode = EXTEND;
-       else
-               signal_status.emit("No free endpoints");
-
-       return ok;
-}
-
-void Manipulator::duplicate()
-{
-       if(mode)
-               cancel();
-
-       list<Object *> new_objs;
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-       {
-               Object *obj = i->object->clone(&designer.get_layout());
-               for(list<Object *>::iterator j=new_objs.begin(); j!=new_objs.end(); ++j)
-                       obj->link_to(**j);
-               new_objs.push_back(obj);
-       }
-
-       selection.replace(new_objs.begin(), new_objs.end());
-}
-
-void Manipulator::flatten()
-{
-       if(mode)
-               cancel();
-
-       if(objects.empty())
-               return;
-
-       float z = 0;
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-       {
-               z += i->object->get_position().z;
-               if(Track *track = dynamic_cast<Track *>(i->object))
-                       z += track->get_slope()/2;
-       }
-       z /= static_cast<int>(objects.size());
-
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-       {
-               Vector p = i->object->get_position();
-               i->object->set_position(Vector(p.x, p.y, z));
-               if(Track *track = dynamic_cast<Track *>(i->object))
-                       track->set_slope(0);
-       }
-
-       for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
-               (*i)->check_slope();
-
-       update_objects();
-}
-
-void Manipulator::even_slope(bool smooth)
-{
-       if(mode)
-               cancel();
-
-       if(neighbors.size()!=2)
-               return;
-
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-               if(i->object->get_n_link_slots()!=2)
-                       return;
-
-       list<Track *> tracks2;
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-               if(Track *track = dynamic_cast<Track *>(i->object))
-                       tracks2.push_back(track);
-
-       float total_len = 0;
-
-       list<TrackOrder> order;
-       Track *cur = *neighbors.begin();
-       while(tracks2.size())
-       {
-               bool rev = false;
-               for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
-               {
-                       const vector<Track *> &links = (*i)->get_links();
-                       if(links[0]==cur)
-                       {
-                               cur = *i;
-                               tracks2.erase(i);
-                               break;
-                       }
-                       else if(links[1]==cur)
-                       {
-                               cur = *i;
-                               rev = true;
-                               tracks2.erase(i);
-                               break;
-                       }
-               }
-               order.push_back(TrackOrder(cur, rev));
-               total_len += cur->get_type().get_total_length();
-       }
-
-       set<Track *>::iterator nb = neighbors.begin();
-       int epi = (*nb)->get_link_slot(*order.front().track);
-       float start_z = (*nb)->get_snap_node(epi).position.z;
-       ++nb;
-       epi = (*nb)->get_link_slot(*order.back().track);
-       float end_z = (*nb)->get_snap_node(epi).position.z;
-
-       if(smooth)
-       {
-               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;
-
-                       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();
-                       order.erase(order.begin());
-
-                       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();
-                       order.erase(--order.end());
-               }
-       }
-
-       float cur_z = start_z;
-       for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
-       {
-               float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
-               set_slope(*i, cur_z, dz);
-               cur_z += dz;
-       }
-
-       for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
-               (*i)->check_slope();
-
-       update_objects();
-}
-
-void Manipulator::connect()
-{
-       if(objects.size()!=2)
-       {
-               signal_status.emit("Exactly two tracks must be selected");
-               return;
-       }
-
-       Track *track1 = dynamic_cast<Track *>(objects.front().object);
-       Track *track2 = dynamic_cast<Track *>(objects.back().object);
-       if(!track1 || !track2)
-       {
-               signal_status.emit("Exactly two tracks must be selected");
-               return;
-       }
-
-       float limit = designer.get_layout().get_catalogue().get_gauge()/10;
-
-       Snap sn1;
-       bool ok = false;
-       float gap = 0;
-       for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
-       {
-               if(track1->get_link(i))
-                       continue;
-
-               sn1 = track1->get_snap_node(i);
-
-               for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
-               {
-                       if(track2->get_link(j))
-                               continue;
-
-                       Snap sn2 = track2->get_snap_node(j);
-
-                       float dz = sn2.position.z-sn1.position.z;
-                       if(abs(dz)>0.02)
-                               continue;
-
-                       float adiff = sn1.rotation+M_PI-sn2.rotation;
-                       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(sn1.rotation);
-                       float s = sin(sn1.rotation);
-                       float dx = sn2.position.x-sn1.position.x;
-                       float dy = sn2.position.y-sn1.position.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(sn1.position, sn1.rotation, gap, limit);
-
-       if(trks.empty())
-       {
-               signal_status.emit("No connection possible");
-               return;
-       }
-
-       trks.front()->link_to(*track1);
-       trks.back()->link_to(*track2);
-
-       selection.replace(trks.begin(), trks.end());
-}
-
-void Manipulator::cancel()
-{
-       if(!mode)
-               return;
-       mode = NONE;
-
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-       {
-               i->object->set_position(Vector(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
-               i->object->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(unsigned btn)
-{
-       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<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
-                                       j->object->break_link(**i);
-               }
-
-               const set<Track *> &ltracks = designer.get_layout().get_tracks();
-               for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
-               {
-                       bool ok = true;
-                       for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
-                               ok = (j->object!=*i);
-                       if(!ok) continue;
-
-                       for(vector<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
-                               j->object->link_to(**i);
-               }
-
-               if(m==EXTEND)
-               {
-                       selection.replace(extend_tracks.begin(), extend_tracks.end());
-                       extend_tracks.clear();
-               }
-               else
-               {
-                       update_objects();
-                       update_neighbors();
-               }
-
-               signal_done.emit(true);
-       }
-}
-
-void Manipulator::axis_motion(unsigned axis, float value, float)
-{
-       if(axis==0)
-               pointer.x = value;
-       else if(axis==1)
-               pointer.y = value;
-       gpointer = designer.map_pointer_to_ground(pointer);
-
-       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<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-               {
-                       i->object->set_position(Vector(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
-                       i->object->set_rotation(i->rot);
-               }
-
-               const set<Track *> &ltracks = designer.get_layout().get_tracks();
-               float limit = max(designer.get_layout().get_catalogue().get_gauge(),
-                       designer.get_camera_controller().get_view_scale()/100.0f);
-               MObject *snapped = 0;
-               for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
-               {
-                       bool ok = true;
-                       for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
-                               ok = (j->object!=*i);
-                       if(!ok)
-                               continue;
-
-                       for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && !snapped); ++j)
-                               if(j->object->snap_to(**i, limit))
-                                       snapped = &*j;
-               }
-
-               if(snapped)
-               {
-                       float da = snapped->object->get_rotation()-snapped->rot;
-                       float c = cos(da);
-                       float s = sin(da);
-                       const Vector &sp = snapped->object->get_position();
-                       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-                       {
-                               if(&*i==snapped)
-                                       continue;
-
-                               Vector dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
-                               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));
-                               i->object->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<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-               {
-                       float c = cos(angle);
-                       float s = sin(angle);
-                       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));
-                       i->object->set_rotation(angle+i->rot);
-               }
-       }
-       else if(mode==ELEVATE && axis==1)
-       {
-               float dz = pointer.y-elev_origin;
-
-               signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
-
-               for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-                       i->object->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<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-               {
-                       unsigned nls = i->object->get_n_link_slots();
-                       for(unsigned j=0; j<nls; ++j)
-                       {
-                               if(i->object->get_link(j))
-                                       continue;
-
-                               Snap sn = i->object->get_snap_node(j);
-                               float c = cos(sn.rotation);
-                               float s = sin(sn.rotation);
-                               float dx = gpointer.x-sn.position.x;
-                               float dy = gpointer.y-sn.position.y;
-
-                               float len = dx*c+dy*s;
-                               if(len<length)
-                                       continue;
-
-                               pos = sn.position;
-                               dir = sn.rotation;
-                               length = len;
-                       }
-               }
-
-               if(length)
-               {
-                       vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
-
-                       if(!trks.empty())
-                       {
-                               for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
-                                       delete *i;
-                               extend_tracks = trks;
-
-                               map<ArticleNumber, unsigned> counts;
-                               length = 0;
-                               for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
-                               {
-                                       length += (*i)->get_type().get_total_length();
-                                       ++counts[(*i)->get_type().get_article_number()];
-                               }
-
-                               string detail;
-                               for(map<ArticleNumber, unsigned>::const_iterator i=counts.begin(); i!=counts.end(); ++i)
-                               {
-                                       if(!detail.empty())
-                                               detail += ", ";
-                                       detail += format("%dx %s", i->second, i->first);
-                               }
-
-                               signal_status.emit(format("Extend: %.0fmm (%s)", length*1000, detail));
-                       }
-               }
-       }
-}
-
-void Manipulator::selection_changed()
-{
-       if(mode)
-               cancel();
-
-       objects.clear();
-       set<Object *> pending = selection.get_objects();
+       set<Object *> pending = objs;
        while(!pending.empty())
        {
                for(set<Object *>::iterator i=pending.begin(); i!=pending.end(); )
@@ -526,180 +28,64 @@ void Manipulator::selection_changed()
                }
        }
 
-       update_neighbors();
-       update_objects();
-}
-
-void Manipulator::update_objects()
-{
-       Vector minp, maxp;
+       Geometry::BoundingBox<float, 3> bbox;
        for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
-       {
-               // XXX Use generic bounding box when it is implemented
-               if(Track *track = dynamic_cast<Track *>(i->object))
-               {
-                       unsigned n_endpoints = track->get_type().get_endpoints().size();
-                       for(unsigned j=0; j<n_endpoints; ++j)
-                       {
-                               Vector p = track->get_snap_node(j).position;
-                               if(i==objects.begin() && j==0)
-                                       minp = maxp = p;
-                               else
-                               {
-                                       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);
-                               }
-                       }
-               }
-               else
-               {
-                       const Vector &p = i->object->get_position();
-                       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);
-               }
-       }
+               bbox = bbox|i->object->get_bounding_box();
 
-       center = Vector((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
+       const Vector &minp = bbox.get_minimum_point();
+       const Vector &maxp = bbox.get_maximum_point();
+
+       center = (minp+maxp)/2.0f;
+       center.z = minp.z;
+       for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
        {
-               const Vector &p = i->object->get_position();
-               i->pos = Vector(p.x-center.x, p.y-center.y, p.z-center.z);
-               i->rot = i->object->get_rotation();
+               i->original_position = i->object->get_position()-center;
+               i->original_rotation = i->object->get_rotation();
        }
 }
 
-void Manipulator::update_neighbors()
+Manipulator::~Manipulator()
 {
-       neighbors.clear();
-       for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
+       if(!accepted)
        {
-               Track *track = dynamic_cast<Track *>(i->object);
-               if(!track)
-                       continue;
-
-               const vector<Track *> &links = track->get_links();
-               for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
+               for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
                {
-                       if(!*j)
-                               continue;
-                       if(neighbors.count(*j))
-                               continue;
-
-                       bool ok = true;
-                       for(vector<MObject>::iterator k=objects.begin(); (k!=objects.end() && ok); ++k)
-                               ok = (k->object!=*j);
-
-                       if(ok)
-                               neighbors.insert(*j);
+                       i->object->set_position(center+i->original_position);
+                       i->object->set_rotation(i->original_rotation);
                }
        }
 }
 
-void Manipulator::set_slope(TrackOrder &track, float z, float dz)
+void Manipulator::finish()
 {
-       const Vector &p = track.track->get_position();
-       if(track.rev)
-       {
-               track.track->set_position(Vector(p.x, p.y, z+dz));
-               track.track->set_slope(-dz);
-       }
-       else
+       set<Object *> object_set;
+       for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
+               object_set.insert(i->object);
+       for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
        {
-               track.track->set_position(Vector(p.x, p.y, z));
-               track.track->set_slope(dz);
+               unsigned nls = i->object->get_n_link_slots();
+               for(unsigned j=0; j<nls; ++j)
+                       if(Object *link = i->object->get_link(j))
+                               if(!object_set.count(link))
+                                       i->object->break_link(j);
        }
-}
 
-vector<Track *> Manipulator::create_straight(const R2C2::Vector &start, float dir, float length, float limit)
-{
-       const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
-       std::map<float, const TrackType *> types_by_length;
-       unsigned preference = 0;
-       for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
+       const set<Track *> &ltracks = designer.get_layout().get_all<Track>();
+       for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
        {
-               const vector<TrackPart> &parts = i->second->get_parts();
-               if(parts.size()!=1)
-                       continue;
-               if(parts.front().is_curved() || parts.front().is_dead_end())
-                       continue;
+               bool ok = true;
+               for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
+                       ok = (j->object!=*i);
+               if(!ok) continue;
 
-               types_by_length[parts.front().get_length()] = i->second;
-               preference = max(preference, i->second->get_autofit_preference());
+               for(vector<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
+                       j->object->link_to(**i);
        }
-
-       vector<float> lengths;
-       float removed = 0;
-       while(length>limit)
-       {
-               bool found = false;
-               for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
-               {
-                       --i;
-                       if(i->second->get_autofit_preference()<preference)
-                               continue;
-                       if((!removed || i->first<removed) && i->first<length+limit)
-                       {
-                               unsigned n = static_cast<unsigned>((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<Track *> trks;
-
-       if(!lengths.empty())
-       {
-               Vector pos = start;
-               float c = cos(dir);
-               float s = sin(dir);
-               for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
-               {
-                       Track *track = new Track(designer.get_layout(), *get_item(types_by_length, *i));
-                       track->set_position(pos);
-                       track->set_rotation(dir);
-
-                       if(!trks.empty())
-                               track->link_to(*trks.back());
-                       trks.push_back(track);
-
-                       pos.x += c**i;
-                       pos.y += s**i;
-               }
-       }
-
-       return trks;
 }
 
 
 Manipulator::MObject::MObject(Object *o):
        object(o),
-       pos(object->get_position()),
-       rot(object->get_rotation())
+       original_position(object->get_position()),
+       original_rotation(object->get_rotation())
 { }