3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
10 #include <msp/strings/formatter.h>
11 #include "libmarklin/tracktype.h"
13 #include "manipulator.h"
14 #include "selection.h"
17 using namespace Marklin;
20 Manipulator::Manipulator(Designer &d, Selection &s):
26 selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
29 void Manipulator::start_move()
34 move_origin = gpointer;
39 void Manipulator::start_rotate()
44 rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
49 void Manipulator::start_elevate()
54 elev_origin = pointer_y;
59 void Manipulator::duplicate()
64 list<Track *> new_tracks;
65 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
67 Track *track = new Track(*designer.get_layout(), i->track->get_type());
68 track->set_position(i->track->get_position());
69 track->set_rotation(i->track->get_rotation());
70 new_tracks.push_back(track);
74 for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
76 selection.add_track(*i);
77 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
79 (*i)->snap_to(**j, true);
83 void Manipulator::flatten()
88 if(tracks.empty()) return;
91 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
92 z += i->track->get_position().z+i->track->get_slope()/2;
95 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
97 Point p = i->track->get_position();
98 i->track->set_position(Point(p.x, p.y, z));
99 i->track->set_slope(0);
102 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
108 void Manipulator::even_slope(bool smooth)
113 if(neighbors.size()!=2)
116 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
117 if(i->track->get_type().get_endpoints().size()!=2)
120 list<Track *> tracks2;
121 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
122 tracks2.push_back(i->track);
126 list<TrackOrder> order;
127 Track *cur = *neighbors.begin();
128 while(tracks2.size())
131 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
133 const vector<Track *> &links = (*i)->get_links();
140 else if(links[1]==cur)
148 order.push_back(TrackOrder(cur, rev));
149 total_len += cur->get_type().get_total_length();
152 set<Track *>::iterator nb = neighbors.begin();
153 int epi = (*nb)->get_endpoint_by_link(*order.front().track);
154 float start_z = (*nb)->get_endpoint_position(epi).z;
156 epi = (*nb)->get_endpoint_by_link(*order.back().track);
157 float end_z = (*nb)->get_endpoint_position(epi).z;
161 float dir = (end_z>start_z)?1:-1;
163 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
167 float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
168 set_slope(order.front(), start_z, dz);
170 total_len -= order.front().track->get_type().get_total_length();
171 order.erase(order.begin());
173 dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
174 set_slope(order.back(), end_z-dz, dz);
176 total_len -= order.back().track->get_type().get_total_length();
177 order.erase(--order.end());
181 float cur_z = start_z;
182 for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
184 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
185 set_slope(*i, cur_z, dz);
189 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
195 void Manipulator::cancel()
201 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
203 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
204 i->track->set_rotation(i->rot);
207 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
212 signal_done.emit(false);
215 void Manipulator::button_press(int, int, float, float, unsigned btn)
224 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
225 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
226 j->track->break_link(**i);
228 const set<Track *> <racks = designer.get_layout()->get_tracks();
229 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
232 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
236 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
237 j->track->snap_to(**i, true);
243 signal_done.emit(true);
247 void Manipulator::pointer_motion(int, int y, float gx, float gy)
250 gpointer = Point(gx, gy, 0);
254 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
255 Point offset(center.x+delta.x, center.y+delta.y, center.z);
256 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
258 i->track->set_position(Point(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
259 i->track->set_rotation(i->rot);
262 const set<Track *> <racks = designer.get_layout()->get_tracks();
264 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
267 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
271 for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
272 if(j->track->snap_to(**i, false))
278 float da = snapped->track->get_rotation()-snapped->rot;
281 const Point &sp = snapped->track->get_position();
282 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
287 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
288 i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z));
289 i->track->set_rotation(i->rot+da);
293 else if(mode==ROTATE)
295 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
296 angle += a-rot_origin;
299 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
301 float c = cos(angle);
302 float s = sin(angle);
303 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));
304 i->track->set_rotation(angle+i->rot);
307 else if(mode==ELEVATE)
309 float dz = (y-elev_origin)/1000.;
311 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
313 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
314 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
316 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
321 void Manipulator::selection_changed()
327 const set<Track *> &stracks = selection.get_tracks();
328 tracks.insert(tracks.end(), stracks.begin(), stracks.end());
334 void Manipulator::update_tracks()
337 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
339 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
340 for(unsigned j=0; j<n_endpoints; ++j)
342 Point p = i->track->get_endpoint_position(j);
343 if(i==tracks.begin() && j==0)
347 minp.x = min(minp.x, p.x);
348 maxp.x = max(maxp.x, p.x);
349 minp.y = min(minp.y, p.y);
350 maxp.y = max(maxp.y, p.y);
351 minp.z = min(minp.z, p.z);
356 center = Point((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
357 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
359 const Point &tp = i->track->get_position();
360 i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z);
361 i->rot = i->track->get_rotation();
365 void Manipulator::update_neighbors()
368 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
370 const vector<Track *> &links = i->track->get_links();
371 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
375 if(neighbors.count(*j))
379 for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
383 neighbors.insert(*j);
388 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
390 const Point &p = track.track->get_position();
393 track.track->set_position(Point(p.x, p.y, z+dz));
394 track.track->set_slope(-dz);
398 track.track->set_position(Point(p.x, p.y, z));
399 track.track->set_slope(dz);
403 Manipulator::MTrack::MTrack(Track *t):
405 pos(track->get_position()),
406 rot(track->get_rotation())