using namespace R2C2;
using namespace Msp;
-Manipulator::Manipulator(Designer &d, Input::Mouse &m, Selection &s):
- designer(d),
- mouse(m),
- selection(s),
- mode(NONE)
+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 = Geometry::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);
- }
-
- 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 = dynamic_cast<Track *>(*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<Object *>::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;
- }
-
- 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;
-
- Angle adiff = wrap_balanced(sn1.rotation+Angle::half_turn()-sn2.rotation);
- if(abs(adiff).radians()>0.01)
- continue;
-
- Vector delta = rotated_vector(sn2.position-sn1.position, -sn1.rotation);
- if(abs(delta.y)>limit)
- continue;
-
- gap = delta.x;
- 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(center+i->pos);
- i->object->set_rotation(i->rot);
- }
-
- for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
- delete *i;
- extend_tracks.clear();
-
- angle = Angle::zero();
-
- 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 = Angle::zero();
-
- if(m!=EXTEND)
- {
- for(set<Object *>::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 *> <racks = designer.get_layout().get_all<Track>();
- 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 offset = center+gpointer-move_origin;
- for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
- {
- i->object->set_position(offset+i->pos);
- i->object->set_rotation(i->rot);
- }
-
- const set<Track *> <racks = designer.get_layout().get_all<Track>();
- 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)
- {
- Angle da = snapped->object->get_rotation()-snapped->rot;
- Transform trans = Transform::rotation(da, Vector(0, 0, 1));
- const Vector &sp = snapped->object->get_position();
- for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
- {
- if(&*i==snapped)
- continue;
-
- i->object->set_position(sp+trans.transform(i->pos-snapped->pos));
- i->object->set_rotation(i->rot+da);
- }
- }
- }
- else if(mode==ROTATE)
- {
- Angle a = Geometry::atan2(gpointer.y-center.y, gpointer.x-center.x);
- angle += a-rot_origin;
- rot_origin = a;
-
- Transform trans = Transform::rotation(angle, Vector(0, 0, 1));
- for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
- {
- i->object->set_position(center+trans.transform(i->pos));
- 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(center+i->pos+Vector(0, 0, dz));
- }
- else if(mode==EXTEND)
- {
- Vector pos;
- Angle dir;
- 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);
- Vector delta = rotated_vector(gpointer-sn.position, -sn.rotation);
-
- if(delta.x<length)
- continue;
-
- pos = sn.position;
- dir = sn.rotation;
- length = delta.x;
- }
- }
-
- 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(); )
}
}
- update_neighbors();
- update_objects();
-}
-
-void Manipulator::update_objects()
-{
Geometry::BoundingBox<float, 3> bbox;
for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
bbox = bbox|i->object->get_bounding_box();
center = (minp+maxp)/2.0f;
center.z = minp.z;
- for(vector<MObject>::iterator i=objects.begin(); i!=objects.end(); ++i)
+ for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
{
- i->pos = i->object->get_position()-center;
- 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)
{
- unsigned nls = i->object->get_n_link_slots();
- for(unsigned j=0; j<nls; ++j)
+ for(ObjectArray::iterator i=objects.begin(); i!=objects.end(); ++i)
{
- Object *linked = i->object->get_link(j);
- if(!linked)
- continue;
- if(neighbors.count(linked))
- continue;
-
- bool ok = true;
- for(vector<MObject>::iterator k=objects.begin(); (k!=objects.end() && ok); ++k)
- ok = (k->object!=linked);
-
- if(ok)
- neighbors.insert(linked);
+ 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);
- }
-}
-
-vector<Track *> Manipulator::create_straight(const R2C2::Vector &start, const Angle &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 vector<TrackPart> &parts = i->second->get_parts();
- if(parts.size()!=1)
- continue;
- if(parts.front().is_curved() || parts.front().is_dead_end())
- continue;
-
- types_by_length[parts.front().get_length()] = i->second;
- preference = max(preference, i->second->get_autofit_preference());
- }
-
- 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();
+ 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 *> trks;
-
- if(!lengths.empty())
+ const set<Track *> <racks = designer.get_layout().get_all<Track>();
+ for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
{
- Vector pos = start;
- Transform trans = Transform::rotation(dir, Vector(0, 0, 1));
- 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);
+ bool ok = true;
+ for(vector<MObject>::iterator j=objects.begin(); (j!=objects.end() && ok); ++j)
+ ok = (j->object!=*i);
+ if(!ok) continue;
- if(!trks.empty())
- track->link_to(*trks.back());
- trks.push_back(track);
-
- pos += trans.transform(Vector(*i, 0, 0));
- }
+ for(vector<MObject>::iterator j=objects.begin(); j!=objects.end(); ++j)
+ j->object->link_to(**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())
{ }