source/designer/manipulator.cpp

   1 /* $Id$
   2
   3 This file is part of the MSP Märklin suite
   4 Copyright © 2006-2010  Mikkosoft Productions, Mikko Rasa
   5 Distributed under the GPL
   6 */
   7
   8 #include <algorithm>
   9 #include <cmath>
  10 #include <GL/gl.h>
  11 #include <msp/strings/formatter.h>
  12 #include "3d/layout.h"
  13 #include "libmarklin/tracktype.h"
  14 #include "designer.h"
  15 #include "manipulator.h"
  16 #include "selection.h"
  17
  18 using namespace std;
  19 using namespace Marklin;
  20 using namespace Msp;
  21
  22 Manipulator::Manipulator(Designer &d, Selection &s):
  23         designer(d),
  24         selection(s),
  25         wrap_rot(0),
  26         mode(NONE),
  27         angle(0)
  28 {
  29         selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
  30 }
  31
  32 void Manipulator::start_move()
  33 {
  34         if(mode)
  35                 cancel();
  36
  37         move_origin = gpointer;
  38
  39         mode = MOVE;
  40 }
  41
  42 void Manipulator::start_rotate()
  43 {
  44         if(mode)
  45                 cancel();
  46
  47         rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
  48
  49         mode = ROTATE;
  50 }
  51
  52 void Manipulator::start_elevate()
  53 {
  54         if(mode)
  55                 cancel();
  56
  57         elev_origin = pointer_y;
  58
  59         mode = ELEVATE;
  60 }
  61
  62 void Manipulator::duplicate()
  63 {
  64         if(mode)
  65                 cancel();
  66
  67         list<Track *> new_tracks;
  68         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
  69         {
  70                 Track *track = new Track(*designer.get_layout(), i->track->get_type());
  71                 track->set_position(i->track->get_position());
  72                 track->set_rotation(i->track->get_rotation());
  73                 new_tracks.push_back(track);
  74         }
  75
  76         selection.clear();
  77         for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
  78         {
  79                 selection.add_track(*i);
  80                 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
  81                         if(j!=i)
  82                                 (*i)->snap_to(**j, true);
  83         }
  84 }
  85
  86 void Manipulator::flatten()
  87 {
  88         if(mode)
  89                 cancel();
  90
  91         if(tracks.empty()) return;
  92
  93         float z = 0;
  94         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
  95                 z += i->track->get_position().z+i->track->get_slope()/2;
  96         z /= tracks.size();
  97
  98         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
  99         {
 100                 Point p = i->track->get_position();
 101                 i->track->set_position(Point(p.x, p.y, z));
 102                 i->track->set_slope(0);
 103         }
 104
 105         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 106                 (*i)->check_slope();
 107
 108         update_wrap();
 109 }
 110
 111 void Manipulator::even_slope(bool smooth)
 112 {
 113         if(mode)
 114                 cancel();
 115
 116         if(neighbors.size()!=2)
 117                 return;
 118
 119         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 120                 if(i->track->get_type().get_endpoints().size()!=2)
 121                         return;
 122
 123         list<Track *> tracks2;
 124         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 125                 tracks2.push_back(i->track);
 126
 127         float total_len = 0;
 128
 129         list<TrackOrder> order;
 130         Track *cur = *neighbors.begin();
 131         while(tracks2.size())
 132         {
 133                 bool rev = false;
 134                 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
 135                 {
 136                         const vector<Track *> &links = (*i)->get_links();
 137                         if(links[0]==cur)
 138                         {
 139                                 cur = *i;
 140                                 tracks2.erase(i);
 141                                 break;
 142                         }
 143                         else if(links[1]==cur)
 144                         {
 145                                 cur = *i;
 146                                 rev = true;
 147                                 tracks2.erase(i);
 148                                 break;
 149                         }
 150                 }
 151                 order.push_back(TrackOrder(cur, rev));
 152                 total_len += cur->get_type().get_total_length();
 153         }
 154
 155         set<Track *>::iterator nb = neighbors.begin();
 156         int epi = (*nb)->get_endpoint_by_link(*order.front().track);
 157         float start_z = (*nb)->get_endpoint_position(epi).z;
 158         ++nb;
 159         epi = (*nb)->get_endpoint_by_link(*order.back().track);
 160         float end_z = (*nb)->get_endpoint_position(epi).z;
 161
 162         if(smooth)
 163         {
 164                 float dir = (end_z>start_z)?1:-1;
 165                 float cur_slope = 0;
 166                 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
 167                 {
 168                         cur_slope += 0.025;
 169
 170                         float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
 171                         set_slope(order.front(), start_z, dz);
 172                         start_z += dz;
 173                         total_len -= order.front().track->get_type().get_total_length();
 174                         order.erase(order.begin());
 175
 176                         dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
 177                         set_slope(order.back(), end_z-dz, dz);
 178                         end_z -= dz;
 179                         total_len -= order.back().track->get_type().get_total_length();
 180                         order.erase(--order.end());
 181                 }
 182         }
 183
 184         float cur_z = start_z;
 185         for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
 186         {
 187                 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
 188                 set_slope(*i, cur_z, dz);
 189                 cur_z += dz;
 190         }
 191
 192         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 193                 (*i)->check_slope();
 194
 195         update_wrap();
 196 }
 197
 198 void Manipulator::cancel()
 199 {
 200         if(!mode)
 201                 return;
 202         mode = NONE;
 203
 204         wrap_pos = center;
 205         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 206         {
 207                 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
 208                 i->track->set_rotation(i->rot);
 209         }
 210
 211         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 212                 (*i)->check_slope();
 213
 214         angle = 0;
 215         wrap_rot = 0;
 216
 217         signal_done.emit(false);
 218 }
 219
 220 void Manipulator::button_press(int, int, float, float, unsigned btn)
 221 {
 222         if(btn==3)
 223                 cancel();
 224         else if(mode)
 225         {
 226                 mode = NONE;
 227                 update_wrap();
 228                 angle = 0;
 229
 230                 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 231                         for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
 232                                 j->track->break_link(**i);
 233
 234                 const set<Track *> &ltracks = designer.get_layout()->get_tracks();
 235                 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
 236                 {
 237                         bool ok = true;
 238                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
 239                                 ok = (j->track!=*i);
 240                         if(!ok) continue;
 241
 242                         for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
 243                                 j->track->snap_to(**i, true);
 244                 }
 245
 246                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 247                         i->rot = i->track->get_rotation();
 248
 249                 update_neighbors();
 250
 251                 signal_done.emit(true);
 252         }
 253 }
 254
 255 void Manipulator::pointer_motion(int, int y, float gx, float gy)
 256 {
 257         pointer_y = y;
 258         gpointer = Point(gx, gy, 0);
 259
 260         if(mode==MOVE)
 261         {
 262                 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
 263
 264                 wrap_pos = Point(center.x+delta.x, center.y+delta.y, center.z);
 265                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 266                 {
 267                         i->track->set_position(Point(wrap_pos.x+i->pos.x, wrap_pos.y+i->pos.y, wrap_pos.z+i->pos.z));
 268                         i->track->set_rotation(i->rot);
 269                 }
 270
 271                 const set<Track *> &ltracks = designer.get_layout()->get_tracks();
 272                 MTrack *snapped = 0;
 273                 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
 274                 {
 275                         bool ok = true;
 276                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
 277                                 ok = (j->track!=*i);
 278                         if(!ok) continue;
 279
 280                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
 281                                 if(j->track->snap_to(**i, false))
 282                                         snapped = &*j;
 283                 }
 284
 285                 if(snapped)
 286                 {
 287                         float da = snapped->track->get_rotation()-snapped->rot;
 288                         float c = cos(da);
 289                         float s = sin(da);
 290                         const Point &sp = snapped->track->get_position();
 291                         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 292                         {
 293                                 if(&*i==snapped)
 294                                         continue;
 295
 296                                 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
 297                                 i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z));
 298                                 i->track->set_rotation(i->rot+da);
 299                         }
 300                 }
 301         }
 302         else if(mode==ROTATE)
 303         {
 304                 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
 305                 angle += a-rot_origin;
 306                 rot_origin = a;
 307
 308                 wrap_rot = angle;
 309                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 310                 {
 311                         float c = cos(angle);
 312                         float s = sin(angle);
 313                         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));
 314                         i->track->set_rotation(angle+i->rot);
 315                 }
 316         }
 317         else if(mode==ELEVATE)
 318         {
 319                 float dz = (y-elev_origin)/1000.;
 320
 321                 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
 322
 323                 wrap_pos.z = center.z+dz;
 324                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 325                         i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
 326
 327                 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 328                         (*i)->check_slope();
 329         }
 330 }
 331
 332 void Manipulator::render()
 333 {
 334         glPushMatrix();
 335         glTranslatef(wrap_pos.x, wrap_pos.y, wrap_pos.z);
 336         glRotatef(wrap_rot*180/M_PI, 0, 0, 1);
 337
 338         glLineWidth(2);
 339         glColor4f(0, 1, 0, 0.5);
 340         for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
 341         {
 342                 glPushMatrix();
 343                 glTranslatef(i->pos.x, i->pos.y, i->pos.z);
 344                 glRotatef(i->rot*180/M_PI, 0, 0, 1);
 345
 346                 glBegin(GL_LINE_LOOP);
 347                 glVertex2f(-i->width/2, -i->height/2);
 348                 glVertex2f(i->width/2, -i->height/2);
 349                 glVertex2f(i->width/2, i->height/2);
 350                 glVertex2f(-i->width/2, i->height/2);
 351                 glEnd();
 352
 353                 glPopMatrix();
 354         }
 355
 356         glPopMatrix();
 357 }
 358
 359 void Manipulator::selection_changed()
 360 {
 361         if(mode)
 362                 cancel();
 363
 364         tracks.clear();
 365         const set<Track *> &stracks = selection.get_tracks();
 366         tracks.insert(tracks.end(), stracks.begin(), stracks.end());
 367
 368         update_neighbors();
 369         update_wrap();
 370 }
 371
 372 void Manipulator::update_wrap()
 373 {
 374         wrap.clear();
 375         float min_x = 0, max_x = 0;
 376         float min_y = 0, max_y = 0;
 377         float min_z = 0;
 378         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 379         {
 380                 Track3D &t3d = designer.get_layout_3d()->get_track(*i->track);
 381
 382                 TrackWrap tw;
 383                 float min_area = 100;
 384                 for(float a=0; a<M_PI; a+=0.01)
 385                 {
 386                         Point minp, maxp;
 387                         t3d.get_bounds(a, minp, maxp);
 388                         float area = (maxp.x-minp.x)*(maxp.y-minp.y);
 389                         if(area<min_area)
 390                         {
 391                                 float c = cos(a);
 392                                 float s = sin(a);
 393                                 float x = (minp.x+maxp.x)/2;
 394                                 float y = (minp.y+maxp.y)/2;
 395                                 tw.pos = Point(c*x-s*y, s*x+c*y, minp.z);
 396                                 tw.rot = a;
 397                                 tw.width = maxp.x-minp.x+0.01;
 398                                 tw.height = maxp.y-minp.y+0.01;
 399
 400                                 min_area = area;
 401                         }
 402                 }
 403
 404                 if(i==tracks.begin())
 405                 {
 406                         min_x = max_x = tw.pos.x;
 407                         min_y = max_y = tw.pos.y;
 408                         min_z = tw.pos.z;
 409                 }
 410                 else
 411                 {
 412                         min_x = min(min_x, tw.pos.x);
 413                         max_x = max(max_x, tw.pos.x);
 414                         min_y = min(min_y, tw.pos.y);
 415                         max_y = max(max_y, tw.pos.y);
 416                         min_z = min(min_z, tw.pos.z);
 417                 }
 418                 wrap.push_back(tw);
 419         }
 420
 421         center = Point((min_x+max_x)/2, (min_y+max_y)/2, min_z);
 422         wrap_pos = center;
 423         wrap_rot = 0;
 424         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 425         {
 426                 const Point &tp = i->track->get_position();
 427                 i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z);
 428         }
 429         for(list<TrackWrap>::iterator i=wrap.begin(); i!=wrap.end(); ++i)
 430         {
 431                 i->pos.x -= center.x;
 432                 i->pos.y -= center.y;
 433                 i->pos.z -= center.z;
 434         }
 435 }
 436
 437 void Manipulator::update_neighbors()
 438 {
 439         neighbors.clear();
 440         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 441         {
 442                 const vector<Track *> &links = i->track->get_links();
 443                 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
 444                 {
 445                         if(!*j)
 446                                 continue;
 447                         if(neighbors.count(*j))
 448                                 continue;
 449
 450                         bool ok = true;
 451                         for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
 452                                 ok = (k->track!=*j);
 453
 454                         if(ok)
 455                                 neighbors.insert(*j);
 456                 }
 457         }
 458 }
 459
 460 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
 461 {
 462         const Point &p = track.track->get_position();
 463         if(track.rev)
 464         {
 465                 track.track->set_position(Point(p.x, p.y, z+dz));
 466                 track.track->set_slope(-dz);
 467         }
 468         else
 469         {
 470                 track.track->set_position(Point(p.x, p.y, z));
 471                 track.track->set_slope(dz);
 472         }
 473 }
 474
 475 Manipulator::MTrack::MTrack(Track *t):
 476         track(t),
 477         pos(track->get_position()),
 478         rot(track->get_rotation())
 479 { }