6 #include "manipulator.h"
10 using namespace Marklin;
15 Manipulator::Manipulator(Designer &d):
23 void Manipulator::set_selection(Selection *s)
25 selection_changed_conn.disconnect();
29 selection_changed_conn=selection->signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
34 void Manipulator::start_move()
44 void Manipulator::start_rotate()
49 rot_origin=atan2(gpointer.y-center.y, gpointer.x-center.x);
54 void Manipulator::start_elevate()
59 elev_origin=pointer_y;
64 void Manipulator::duplicate()
70 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
72 Track *track=i->track->copy();
73 designer.get_layout()->add_track(track);
74 new_tracks.push_back(track);
78 for(TrackSeq::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
80 selection->add_track(*i);
81 for(TrackSeq::iterator j=i; j!=new_tracks.end(); ++j)
83 (*i)->snap_to(**j, true);
87 void Manipulator::flatten()
92 if(tracks.empty()) return;
95 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
96 z+=i->track->get_position().z+i->track->get_slope()/2;
99 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
101 Point p=i->track->get_position();
102 i->track->set_position(Point(p.x, p.y, z));
103 i->track->set_slope(0);
106 for(TrackSeq::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
112 void Manipulator::even_slope(bool smooth)
117 if(neighbors.size()!=2)
120 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
121 if(i->track->get_endpoints().size()!=2)
125 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
126 tracks2.push_back(i->track);
131 Track *cur=neighbors.front();
132 while(tracks2.size())
135 for(TrackSeq::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
137 const Track::EndpointSeq &epl=(*i)->get_endpoints();
138 if(epl.front().link==cur)
144 else if(epl.back().link==cur)
152 order.push_back(TrackOrder(cur, rev));
153 total_len+=cur->get_length();
156 const Track::Endpoint *ep=neighbors.front()->get_endpoint_by_link(order.front().track);
157 float start_z=neighbors.front()->get_position().z+ep->pos.z;
158 ep=neighbors.back()->get_endpoint_by_link(order.back().track);
159 float end_z=neighbors.back()->get_position().z+ep->pos.z;
163 float dir=(end_z>start_z)?1:-1;
165 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
169 float dz=order.front().track->get_length()*dir*cur_slope;
170 set_slope(order.front(), start_z, dz);
172 total_len-=order.front().track->get_length();
173 order.erase(order.begin());
175 dz=order.back().track->get_length()*dir*cur_slope;
176 set_slope(order.back(), end_z-dz, dz);
178 total_len-=order.back().track->get_length();
179 order.erase(--order.end());
184 for(TrackOrderSeq::iterator i=order.begin(); i!=order.end(); ++i)
186 float dz=i->track->get_length()*(end_z-start_z)/total_len;
187 set_slope(*i, cur_z, dz);
191 for(TrackSeq::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
197 void Manipulator::cancel()
204 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
206 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
207 i->track->set_rotation(i->rot);
210 for(TrackSeq::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
216 signal_done.emit(false);
219 void Manipulator::button_press(int, int, float, float, unsigned btn)
229 for(TrackSeq::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
230 for(MTrackSeq::iterator j=tracks.begin(); j!=tracks.end(); ++j)
231 j->track->break_link(**i);
233 const TrackSeq <racks=designer.get_layout()->get_tracks();
234 for(TrackSeq::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
237 for(MTrackSeq::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
241 for(MTrackSeq::iterator j=tracks.begin(); j!=tracks.end(); ++j)
242 j->track->snap_to(**i, true);
247 signal_done.emit(true);
251 void Manipulator::pointer_motion(int, int y, float gx, float gy)
254 gpointer=Point(gx, gy, 0);
258 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
260 wrap_pos=Point(center.x+delta.x, center.y+delta.y, center.z);
261 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
263 i->track->set_position(Point(wrap_pos.x+i->pos.x, wrap_pos.y+i->pos.y, wrap_pos.z+i->pos.z));
264 i->track->set_rotation(i->rot);
267 const TrackSeq <racks=designer.get_layout()->get_tracks();
269 for(TrackSeq::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
272 for(MTrackSeq::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
276 for(MTrackSeq::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
277 if(j->track->snap_to(**i, false))
283 float da=snapped->track->get_rotation()-snapped->rot;
286 const Point &sp=snapped->track->get_position();
287 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
292 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
293 i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z));
294 i->track->set_rotation(i->rot+da);
298 else if(mode==ROTATE)
300 float a=atan2(gpointer.y-center.y, gpointer.x-center.x);
305 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
309 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));
310 i->track->set_rotation(angle+i->rot);
313 else if(mode==ELEVATE)
315 float dz=(y-elev_origin)/1000.;
319 ss<<"Elevation: "<<dz*1000<<"mm ("<<(center.z+dz)*1000<<"mm)";
320 signal_status.emit(ss.str());
322 wrap_pos.z=center.z+dz;
323 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
324 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
326 for(TrackSeq::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
331 void Manipulator::render()
334 glTranslatef(wrap_pos.x, wrap_pos.y, wrap_pos.z);
335 glRotatef(wrap_rot*180/M_PI, 0, 0, 1);
338 glColor4f(0, 1, 0, 0.5);
339 for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
342 glTranslatef(i->pos.x, i->pos.y, i->pos.z);
343 glRotatef(i->rot*180/M_PI, 0, 0, 1);
345 glBegin(GL_LINE_LOOP);
346 glVertex2f(-i->width/2, -i->height/2);
347 glVertex2f(i->width/2, -i->height/2);
348 glVertex2f(i->width/2, i->height/2);
349 glVertex2f(-i->width/2, i->height/2);
360 void Manipulator::selection_changed()
368 const Selection::TrackSet &stracks=selection->get_tracks();
369 tracks.insert(tracks.end(), stracks.begin(), stracks.end());
376 void Manipulator::update_wrap()
379 float min_x=0,max_x=0;
380 float min_y=0,max_y=0;
381 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
383 Track3D *t3d=designer.get_layout_3d()->get_track(i->track);
387 for(float a=0; a<M_PI; a+=0.01)
390 t3d->get_bounds(a, minp, maxp);
391 float area=(maxp.x-minp.x)*(maxp.y-minp.y);
396 float x=(minp.x+maxp.x)/2;
397 float y=(minp.y+maxp.y)/2;
398 tw.pos=Point(c*x-s*y, s*x+c*y, (minp.z+maxp.z)/2);
400 tw.width=maxp.x-minp.x+0.01;
401 tw.height=maxp.y-minp.y+0.01;
407 if(i==tracks.begin())
409 min_x=max_x=tw.pos.x;
410 min_y=max_y=tw.pos.y;
414 min_x=min(min_x, tw.pos.x);
415 max_x=max(max_x, tw.pos.x);
416 min_y=min(min_y, tw.pos.y);
417 max_y=max(max_y, tw.pos.y);
422 center=Point((min_x+max_x)/2, (min_y+max_y)/2, 0);
425 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
427 const Point &tp=i->track->get_position();
428 i->pos=Point(tp.x-center.x, tp.y-center.y, tp.z);
430 for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
437 void Manipulator::update_neighbors()
440 for(MTrackSeq::iterator i=tracks.begin(); i!=tracks.end(); ++i)
442 const Track::EndpointSeq &epl=i->track->get_endpoints();
443 for(Track::EndpointSeq::const_iterator j=epl.begin(); j!=epl.end(); ++j)
447 if(find(neighbors.begin(), neighbors.end(), j->link)!=neighbors.end())
451 for(MTrackSeq::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
452 ok=(k->track!=j->link);
455 neighbors.push_back(j->link);
460 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
462 const Point &p=track.track->get_position();
465 track.track->set_position(Point(p.x, p.y, z+dz));
466 track.track->set_slope(-dz);
470 track.track->set_position(Point(p.x, p.y, z));
471 track.track->set_slope(dz);
475 Manipulator::MTrack::MTrack(Track *t):
477 pos(track->get_position()),
478 rot(track->get_rotation())