5 #include "libmarklin/tracktype.h"
7 #include "manipulator.h"
11 using namespace Marklin;
16 Manipulator::Manipulator(Designer &d):
24 void Manipulator::set_selection(Selection *s)
26 selection_changed_conn.disconnect();
30 selection_changed_conn=selection->signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
35 void Manipulator::start_move()
45 void Manipulator::start_rotate()
50 rot_origin=atan2(gpointer.y-center.y, gpointer.x-center.x);
55 void Manipulator::start_elevate()
60 elev_origin=pointer_y;
65 void Manipulator::duplicate()
70 list<Track *> new_tracks;
71 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
73 Track *track=i->track->copy();
74 designer.get_layout()->add_track(*track);
75 new_tracks.push_back(track);
79 for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
81 selection->add_track(*i);
82 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
84 (*i)->snap_to(**j, true);
88 void Manipulator::flatten()
93 if(tracks.empty()) return;
96 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
97 z+=i->track->get_position().z+i->track->get_slope()/2;
100 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
102 Point p=i->track->get_position();
103 i->track->set_position(Point(p.x, p.y, z));
104 i->track->set_slope(0);
107 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
113 void Manipulator::even_slope(bool smooth)
118 if(neighbors.size()!=2)
121 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
122 if(i->track->get_type().get_endpoints().size()!=2)
125 list<Track *> tracks2;
126 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
127 tracks2.push_back(i->track);
131 list<TrackOrder> order;
132 Track *cur=*neighbors.begin();
133 while(tracks2.size())
136 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
138 const vector<Track *> &links=(*i)->get_links();
145 else if(links[1]==cur)
153 order.push_back(TrackOrder(cur, rev));
154 total_len+=cur->get_type().get_total_length();
157 set<Track *>::iterator nb=neighbors.begin();
158 int epi=(*nb)->get_endpoint_by_link(*order.front().track);
159 float start_z=(*nb)->get_endpoint_position(epi).z;
161 epi=(*nb)->get_endpoint_by_link(*order.back().track);
162 float end_z=(*nb)->get_endpoint_position(epi).z;
166 float dir=(end_z>start_z)?1:-1;
168 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
172 float dz=order.front().track->get_type().get_total_length()*dir*cur_slope;
173 set_slope(order.front(), start_z, dz);
175 total_len-=order.front().track->get_type().get_total_length();
176 order.erase(order.begin());
178 dz=order.back().track->get_type().get_total_length()*dir*cur_slope;
179 set_slope(order.back(), end_z-dz, dz);
181 total_len-=order.back().track->get_type().get_total_length();
182 order.erase(--order.end());
187 for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
189 float dz=i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
190 set_slope(*i, cur_z, dz);
194 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
200 void Manipulator::cancel()
207 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
209 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
210 i->track->set_rotation(i->rot);
213 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
219 signal_done.emit(false);
222 void Manipulator::button_press(int, int, float, float, unsigned btn)
232 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
233 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
234 j->track->break_link(**i);
236 const set<Track *> <racks=designer.get_layout()->get_tracks();
237 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
240 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
244 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
245 j->track->snap_to(**i, true);
250 signal_done.emit(true);
254 void Manipulator::pointer_motion(int, int y, float gx, float gy)
257 gpointer=Point(gx, gy, 0);
261 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
263 wrap_pos=Point(center.x+delta.x, center.y+delta.y, center.z);
264 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
266 i->track->set_position(Point(wrap_pos.x+i->pos.x, wrap_pos.y+i->pos.y, wrap_pos.z+i->pos.z));
267 i->track->set_rotation(i->rot);
270 const set<Track *> <racks=designer.get_layout()->get_tracks();
272 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
275 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
279 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
280 if(j->track->snap_to(**i, false))
286 float da=snapped->track->get_rotation()-snapped->rot;
289 const Point &sp=snapped->track->get_position();
290 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
295 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
296 i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z));
297 i->track->set_rotation(i->rot+da);
301 else if(mode==ROTATE)
303 float a=atan2(gpointer.y-center.y, gpointer.x-center.x);
308 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
312 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));
313 i->track->set_rotation(angle+i->rot);
316 else if(mode==ELEVATE)
318 float dz=(y-elev_origin)/1000.;
322 ss<<"Elevation: "<<dz*1000<<"mm ("<<(center.z+dz)*1000<<"mm)";
323 signal_status.emit(ss.str());
325 wrap_pos.z=center.z+dz;
326 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
327 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
329 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
334 void Manipulator::render()
337 glTranslatef(wrap_pos.x, wrap_pos.y, wrap_pos.z);
338 glRotatef(wrap_rot*180/M_PI, 0, 0, 1);
341 glColor4f(0, 1, 0, 0.5);
342 for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
345 glTranslatef(i->pos.x, i->pos.y, i->pos.z);
346 glRotatef(i->rot*180/M_PI, 0, 0, 1);
348 glBegin(GL_LINE_LOOP);
349 glVertex2f(-i->width/2, -i->height/2);
350 glVertex2f(i->width/2, -i->height/2);
351 glVertex2f(i->width/2, i->height/2);
352 glVertex2f(-i->width/2, i->height/2);
363 void Manipulator::selection_changed()
371 const set<Track *> &stracks=selection->get_tracks();
372 tracks.insert(tracks.end(), stracks.begin(), stracks.end());
379 void Manipulator::update_wrap()
382 float min_x=0, max_x=0;
383 float min_y=0, max_y=0;
384 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
386 Track3D &t3d=designer.get_layout_3d()->get_track(*i->track);
390 for(float a=0; a<M_PI; a+=0.01)
393 t3d.get_bounds(a, minp, maxp);
394 float area=(maxp.x-minp.x)*(maxp.y-minp.y);
399 float x=(minp.x+maxp.x)/2;
400 float y=(minp.y+maxp.y)/2;
401 tw.pos=Point(c*x-s*y, s*x+c*y, (minp.z+maxp.z)/2);
403 tw.width=maxp.x-minp.x+0.01;
404 tw.height=maxp.y-minp.y+0.01;
410 if(i==tracks.begin())
412 min_x=max_x=tw.pos.x;
413 min_y=max_y=tw.pos.y;
417 min_x=min(min_x, tw.pos.x);
418 max_x=max(max_x, tw.pos.x);
419 min_y=min(min_y, tw.pos.y);
420 max_y=max(max_y, tw.pos.y);
425 center=Point((min_x+max_x)/2, (min_y+max_y)/2, 0);
428 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
430 const Point &tp=i->track->get_position();
431 i->pos=Point(tp.x-center.x, tp.y-center.y, tp.z);
433 for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
440 void Manipulator::update_neighbors()
443 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
445 const vector<Track *> &links=i->track->get_links();
446 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
450 if(neighbors.count(*j))
454 for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
458 neighbors.insert(*j);
463 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
465 const Point &p=track.track->get_position();
468 track.track->set_position(Point(p.x, p.y, z+dz));
469 track.track->set_slope(-dz);
473 track.track->set_position(Point(p.x, p.y, z));
474 track.track->set_slope(dz);
478 Manipulator::MTrack::MTrack(Track *t):
480 pos(track->get_position()),
481 rot(track->get_rotation())