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 <msp/strings/formatter.h>
  11 #include "libmarklin/tracktype.h"
  12 #include "designer.h"
  13 #include "manipulator.h"
  14 #include "selection.h"
  15
  16 using namespace std;
  17 using namespace Marklin;
  18 using namespace Msp;
  19
  20 Manipulator::Manipulator(Designer &d, Selection &s):
  21         designer(d),
  22         selection(s),
  23         mode(NONE),
  24         angle(0)
  25 {
  26         selection.signal_changed.connect(sigc::mem_fun(this, &Manipulator::selection_changed));
  27 }
  28
  29 void Manipulator::start_move()
  30 {
  31         if(mode)
  32                 cancel();
  33
  34         move_origin = gpointer;
  35
  36         mode = MOVE;
  37 }
  38
  39 void Manipulator::start_rotate()
  40 {
  41         if(mode)
  42                 cancel();
  43
  44         rot_origin = atan2(gpointer.y-center.y, gpointer.x-center.x);
  45
  46         mode = ROTATE;
  47 }
  48
  49 void Manipulator::start_elevate()
  50 {
  51         if(mode)
  52                 cancel();
  53
  54         elev_origin = pointer_y;
  55
  56         mode = ELEVATE;
  57 }
  58
  59 void Manipulator::start_extend()
  60 {
  61         if(mode)
  62                 cancel();
  63
  64         mode = EXTEND;
  65 }
  66
  67 void Manipulator::duplicate()
  68 {
  69         if(mode)
  70                 cancel();
  71
  72         list<Track *> new_tracks;
  73         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
  74         {
  75                 Track *track = new Track(designer.get_layout(), i->track->get_type());
  76                 track->set_position(i->track->get_position());
  77                 track->set_rotation(i->track->get_rotation());
  78                 new_tracks.push_back(track);
  79         }
  80
  81         selection.clear();
  82         for(list<Track *>::iterator i=new_tracks.begin(); i!=new_tracks.end(); ++i)
  83         {
  84                 selection.add_track(*i);
  85                 for(list<Track *>::iterator j=i; j!=new_tracks.end(); ++j)
  86                         if(j!=i)
  87                                 (*i)->snap_to(**j, true);
  88         }
  89 }
  90
  91 void Manipulator::flatten()
  92 {
  93         if(mode)
  94                 cancel();
  95
  96         if(tracks.empty()) return;
  97
  98         float z = 0;
  99         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 100                 z += i->track->get_position().z+i->track->get_slope()/2;
 101         z /= tracks.size();
 102
 103         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 104         {
 105                 Point p = i->track->get_position();
 106                 i->track->set_position(Point(p.x, p.y, z));
 107                 i->track->set_slope(0);
 108         }
 109
 110         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 111                 (*i)->check_slope();
 112
 113         update_tracks();
 114 }
 115
 116 void Manipulator::even_slope(bool smooth)
 117 {
 118         if(mode)
 119                 cancel();
 120
 121         if(neighbors.size()!=2)
 122                 return;
 123
 124         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 125                 if(i->track->get_type().get_endpoints().size()!=2)
 126                         return;
 127
 128         list<Track *> tracks2;
 129         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 130                 tracks2.push_back(i->track);
 131
 132         float total_len = 0;
 133
 134         list<TrackOrder> order;
 135         Track *cur = *neighbors.begin();
 136         while(tracks2.size())
 137         {
 138                 bool rev = false;
 139                 for(list<Track *>::iterator i=tracks2.begin(); i!=tracks2.end(); ++i)
 140                 {
 141                         const vector<Track *> &links = (*i)->get_links();
 142                         if(links[0]==cur)
 143                         {
 144                                 cur = *i;
 145                                 tracks2.erase(i);
 146                                 break;
 147                         }
 148                         else if(links[1]==cur)
 149                         {
 150                                 cur = *i;
 151                                 rev = true;
 152                                 tracks2.erase(i);
 153                                 break;
 154                         }
 155                 }
 156                 order.push_back(TrackOrder(cur, rev));
 157                 total_len += cur->get_type().get_total_length();
 158         }
 159
 160         set<Track *>::iterator nb = neighbors.begin();
 161         int epi = (*nb)->get_endpoint_by_link(*order.front().track);
 162         float start_z = (*nb)->get_endpoint_position(epi).z;
 163         ++nb;
 164         epi = (*nb)->get_endpoint_by_link(*order.back().track);
 165         float end_z = (*nb)->get_endpoint_position(epi).z;
 166
 167         if(smooth)
 168         {
 169                 float dir = (end_z>start_z)?1:-1;
 170                 float cur_slope = 0;
 171                 while((end_z-start_z)*dir/total_len>cur_slope+0.025 && order.size()>2)
 172                 {
 173                         cur_slope += 0.025;
 174
 175                         float dz = order.front().track->get_type().get_total_length()*dir*cur_slope;
 176                         set_slope(order.front(), start_z, dz);
 177                         start_z += dz;
 178                         total_len -= order.front().track->get_type().get_total_length();
 179                         order.erase(order.begin());
 180
 181                         dz = order.back().track->get_type().get_total_length()*dir*cur_slope;
 182                         set_slope(order.back(), end_z-dz, dz);
 183                         end_z -= dz;
 184                         total_len -= order.back().track->get_type().get_total_length();
 185                         order.erase(--order.end());
 186                 }
 187         }
 188
 189         float cur_z = start_z;
 190         for(list<TrackOrder>::iterator i=order.begin(); i!=order.end(); ++i)
 191         {
 192                 float dz = i->track->get_type().get_total_length()*(end_z-start_z)/total_len;
 193                 set_slope(*i, cur_z, dz);
 194                 cur_z += dz;
 195         }
 196
 197         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 198                 (*i)->check_slope();
 199
 200         update_tracks();
 201 }
 202
 203 void Manipulator::connect()
 204 {
 205         if(tracks.size()!=2)
 206         {
 207                 signal_status.emit("Exactly two tracks must be selected");
 208                 return;
 209         }
 210
 211         float limit = 0.001;
 212
 213         Track *track1 = tracks.front().track;
 214         Point pos1;
 215         float dir1;
 216         Track *track2 = tracks.back().track;
 217         bool ok = false;
 218         float gap = 0;
 219         for(unsigned i=0; i<track1->get_type().get_endpoints().size(); ++i)
 220         {
 221                 if(track1->get_link(i))
 222                         continue;
 223
 224                 pos1 = track1->get_endpoint_position(i);
 225                 dir1 = track1->get_endpoint_direction(i);
 226
 227                 for(unsigned j=0; j<track2->get_type().get_endpoints().size(); ++j)
 228                 {
 229                         if(track2->get_link(j))
 230                                 continue;
 231
 232                         Point pos2 = track2->get_endpoint_position(j);
 233                         float dir2 = track2->get_endpoint_direction(j);
 234
 235                         float dz = pos2.z-pos1.z;
 236                         if(abs(dz)>0.02)
 237                                 continue;
 238
 239                         float adiff = dir1+M_PI-dir2;
 240                         while(adiff<-M_PI)
 241                                 adiff += M_PI*2;
 242                         while(adiff>M_PI)
 243                                 adiff -= M_PI*2;
 244                         if(abs(adiff)>0.01)
 245                                 continue;
 246
 247                         float c = cos(dir1);
 248                         float s = sin(dir1);
 249                         float dx = pos2.x-pos1.x;
 250                         float dy = pos2.y-pos1.y;
 251                         if(abs(dx*s-dy*c)>limit)
 252                                 continue;
 253
 254                         gap = dx*c+dy*s;
 255                         if(gap<0)
 256                                 continue;
 257
 258                         ok = true;
 259                 }
 260
 261                 if(ok)
 262                         break;
 263         }
 264
 265         if(!ok)
 266         {
 267                 signal_status.emit("No aligned endpoints found");
 268                 return;
 269         }
 270
 271         vector<Track *> trks = create_straight(pos1, dir1, gap, limit);
 272
 273         if(trks.empty())
 274         {
 275                 signal_status.emit("No connection possible");
 276                 return;
 277         }
 278
 279         trks.front()->snap_to(*track1, true);
 280         trks.back()->snap_to(*track2, true);
 281
 282         selection.replace(trks.begin(), trks.end());
 283 }
 284
 285 void Manipulator::cancel()
 286 {
 287         if(!mode)
 288                 return;
 289         mode = NONE;
 290
 291         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 292         {
 293                 i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z));
 294                 i->track->set_rotation(i->rot);
 295         }
 296
 297         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 298                 (*i)->check_slope();
 299
 300         for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
 301                 delete *i;
 302         extend_tracks.clear();
 303
 304         angle = 0;
 305
 306         signal_done.emit(false);
 307 }
 308
 309 void Manipulator::button_press(int, int, float, float, unsigned btn)
 310 {
 311         if(btn==3)
 312                 cancel();
 313         else if(btn==1 && mode)
 314         {
 315                 Mode m = mode;
 316                 mode = NONE;
 317                 angle = 0;
 318
 319                 if(m!=EXTEND)
 320                 {
 321                         for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 322                                 for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
 323                                         j->track->break_link(**i);
 324                 }
 325
 326                 const set<Track *> &ltracks = designer.get_layout().get_tracks();
 327                 for(set<Track *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
 328                 {
 329                         bool ok = true;
 330                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
 331                                 ok = (j->track!=*i);
 332                         if(!ok) continue;
 333
 334                         for(vector<MTrack>::iterator j=tracks.begin(); j!=tracks.end(); ++j)
 335                                 j->track->snap_to(**i, true);
 336                 }
 337
 338                 if(m==EXTEND)
 339                 {
 340                         selection.replace(extend_tracks.begin(), extend_tracks.end());
 341                         extend_tracks.clear();
 342                 }
 343                 else
 344                 {
 345                         update_tracks();
 346                         update_neighbors();
 347                 }
 348
 349                 signal_done.emit(true);
 350         }
 351 }
 352
 353 void Manipulator::pointer_motion(int, int y, float gx, float gy)
 354 {
 355         pointer_y = y;
 356         gpointer = Point(gx, gy, 0);
 357
 358         if(mode==MOVE)
 359         {
 360                 Point delta(gpointer.x-move_origin.x, gpointer.y-move_origin.y, 0);
 361                 Point offset(center.x+delta.x, center.y+delta.y, center.z);
 362                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 363                 {
 364                         i->track->set_position(Point(offset.x+i->pos.x, offset.y+i->pos.y, offset.z+i->pos.z));
 365                         i->track->set_rotation(i->rot);
 366                 }
 367
 368                 const set<Track *> &ltracks = designer.get_layout().get_tracks();
 369                 MTrack *snapped = 0;
 370                 for(set<Track *>::const_iterator i=ltracks.begin(); (i!=ltracks.end() && !snapped); ++i)
 371                 {
 372                         bool ok = true;
 373                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && ok); ++j)
 374                                 ok = (j->track!=*i);
 375                         if(!ok) continue;
 376
 377                         for(vector<MTrack>::iterator j=tracks.begin(); (j!=tracks.end() && !snapped); ++j)
 378                                 if(j->track->snap_to(**i, false))
 379                                         snapped = &*j;
 380                 }
 381
 382                 if(snapped)
 383                 {
 384                         float da = snapped->track->get_rotation()-snapped->rot;
 385                         float c = cos(da);
 386                         float s = sin(da);
 387                         const Point &sp = snapped->track->get_position();
 388                         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 389                         {
 390                                 if(&*i==snapped)
 391                                         continue;
 392
 393                                 Point dp(i->pos.x-snapped->pos.x, i->pos.y-snapped->pos.y, 0);
 394                                 i->track->set_position(Point(sp.x+c*dp.x-s*dp.y, sp.y+s*dp.x+c*dp.y, sp.z+i->pos.z-snapped->pos.z));
 395                                 i->track->set_rotation(i->rot+da);
 396                         }
 397                 }
 398         }
 399         else if(mode==ROTATE)
 400         {
 401                 float a = atan2(gpointer.y-center.y, gpointer.x-center.x);
 402                 angle += a-rot_origin;
 403                 rot_origin = a;
 404
 405                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 406                 {
 407                         float c = cos(angle);
 408                         float s = sin(angle);
 409                         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));
 410                         i->track->set_rotation(angle+i->rot);
 411                 }
 412         }
 413         else if(mode==ELEVATE)
 414         {
 415                 float dz = (y-elev_origin)/1000.;
 416
 417                 signal_status.emit(format("Elevation: %+.0fmm (%.0fmm)", dz*1000, (center.z+dz)*1000));
 418
 419                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 420                         i->track->set_position(Point(center.x+i->pos.x, center.y+i->pos.y, center.z+i->pos.z+dz));
 421
 422                 for(set<Track *>::iterator i=neighbors.begin(); i!=neighbors.end(); ++i)
 423                         (*i)->check_slope();
 424         }
 425         else if(mode==EXTEND)
 426         {
 427                 Point pos;
 428                 float dir = 0;
 429                 float length = 0;
 430                 for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 431                 {
 432                         unsigned n_endpoints = i->track->get_type().get_endpoints().size();
 433                         for(unsigned j=0; j<n_endpoints; ++j)
 434                         {
 435                                 if(i->track->get_link(j))
 436                                         continue;
 437
 438                                 Point ep_pos = i->track->get_endpoint_position(j);
 439                                 float ep_dir = i->track->get_endpoint_direction(j);
 440                                 float c = cos(ep_dir);
 441                                 float s = sin(ep_dir);
 442                                 float dx = gx-ep_pos.x;
 443                                 float dy = gy-ep_pos.y;
 444
 445                                 float len = dx*c+dy*s;
 446                                 if(len<length)
 447                                         continue;
 448
 449                                 pos = ep_pos;
 450                                 dir = ep_dir;
 451                                 length = len;
 452                         }
 453                 }
 454
 455                 if(length)
 456                 {
 457                         vector<Track *> trks = create_straight(pos, dir, length, max(length/500, 0.001f));
 458
 459                         if(!trks.empty())
 460                         {
 461                                 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
 462                                         delete *i;
 463                                 extend_tracks = trks;
 464
 465                                 length = 0;
 466                                 for(vector<Track *>::iterator i=extend_tracks.begin(); i!=extend_tracks.end(); ++i)
 467                                         length += (*i)->get_type().get_total_length();
 468
 469                                 signal_status.emit(format("Extend: %.0fmm", length*1000));
 470                         }
 471                 }
 472         }
 473 }
 474
 475 void Manipulator::selection_changed()
 476 {
 477         if(mode)
 478                 cancel();
 479
 480         tracks.clear();
 481         const set<Track *> &stracks = selection.get_tracks();
 482         tracks.insert(tracks.end(), stracks.begin(), stracks.end());
 483
 484         update_neighbors();
 485         update_tracks();
 486 }
 487
 488 void Manipulator::update_tracks()
 489 {
 490         Point minp, maxp;
 491         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 492         {
 493                 unsigned n_endpoints = i->track->get_type().get_endpoints().size();
 494                 for(unsigned j=0; j<n_endpoints; ++j)
 495                 {
 496                         Point p = i->track->get_endpoint_position(j);
 497                         if(i==tracks.begin() && j==0)
 498                                 minp = maxp = p;
 499                         else
 500                         {
 501                                 minp.x = min(minp.x, p.x);
 502                                 maxp.x = max(maxp.x, p.x);
 503                                 minp.y = min(minp.y, p.y);
 504                                 maxp.y = max(maxp.y, p.y);
 505                                 minp.z = min(minp.z, p.z);
 506                         }
 507                 }
 508         }
 509
 510         center = Point((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, minp.z);
 511         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 512         {
 513                 const Point &tp = i->track->get_position();
 514                 i->pos = Point(tp.x-center.x, tp.y-center.y, tp.z-center.z);
 515                 i->rot = i->track->get_rotation();
 516         }
 517 }
 518
 519 void Manipulator::update_neighbors()
 520 {
 521         neighbors.clear();
 522         for(vector<MTrack>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 523         {
 524                 const vector<Track *> &links = i->track->get_links();
 525                 for(vector<Track *>::const_iterator j=links.begin(); j!=links.end(); ++j)
 526                 {
 527                         if(!*j)
 528                                 continue;
 529                         if(neighbors.count(*j))
 530                                 continue;
 531
 532                         bool ok = true;
 533                         for(vector<MTrack>::iterator k=tracks.begin(); (k!=tracks.end() && ok); ++k)
 534                                 ok = (k->track!=*j);
 535
 536                         if(ok)
 537                                 neighbors.insert(*j);
 538                 }
 539         }
 540 }
 541
 542 void Manipulator::set_slope(TrackOrder &track, float z, float dz)
 543 {
 544         const Point &p = track.track->get_position();
 545         if(track.rev)
 546         {
 547                 track.track->set_position(Point(p.x, p.y, z+dz));
 548                 track.track->set_slope(-dz);
 549         }
 550         else
 551         {
 552                 track.track->set_position(Point(p.x, p.y, z));
 553                 track.track->set_slope(dz);
 554         }
 555 }
 556
 557 vector<Track *> Manipulator::create_straight(const Marklin::Point &start, float dir, float length, float limit)
 558 {
 559         const Catalogue::TrackMap &track_types = designer.get_catalogue().get_tracks();
 560         std::map<float, const TrackType *> types_by_length;
 561         unsigned preference = 0;
 562         for(Catalogue::TrackMap::const_iterator i=track_types.begin(); i!=track_types.end(); ++i)
 563         {
 564                 const vector<TrackPart> &parts = i->second->get_parts();
 565                 if(parts.size()!=1)
 566                         continue;
 567                 if(parts.front().is_curved() || parts.front().is_dead_end())
 568                         continue;
 569
 570                 types_by_length[parts.front().get_length()] = i->second;
 571                 preference = max(preference, i->second->get_autofit_preference());
 572         }
 573
 574         vector<float> lengths;
 575         float removed = 0;
 576         while(length>limit)
 577         {
 578                 bool found = false;
 579                 for(map<float, const TrackType *>::iterator i=types_by_length.end(); i!=types_by_length.begin(); )
 580                 {
 581                         --i;
 582                         if(i->second->get_autofit_preference()<preference)
 583                                 continue;
 584                         if((!removed || i->first<removed) && i->first<length+limit)
 585                         {
 586                                 unsigned n = static_cast<unsigned>((length+limit)/i->first);
 587                                 lengths.insert(lengths.end(), n, i->first);
 588                                 length -= n*i->first;
 589                                 found = true;
 590                                 break;
 591                         }
 592                 }
 593
 594                 if(found)
 595                         continue;
 596
 597                 if(lengths.empty())
 598                 {
 599                         if(preference>0)
 600                         {
 601                                 --preference;
 602                                 removed = 0;
 603                                 continue;
 604                         }
 605                         break;
 606                 }
 607
 608                 length += lengths.back();
 609                 removed = lengths.back();
 610                 lengths.pop_back();
 611         }
 612
 613         vector<Track *> trks;
 614
 615         if(!lengths.empty())
 616         {
 617                 Point pos = start;
 618                 float c = cos(dir);
 619                 float s = sin(dir);
 620                 for(vector<float>::iterator i=lengths.begin(); i!=lengths.end(); ++i)
 621                 {
 622                         map<float, const TrackType *>::iterator j = types_by_length.find(*i);
 623                         if(j==types_by_length.end())
 624                                 throw LogicError("Internal error");
 625
 626                         Track *track = new Track(designer.get_layout(), *j->second);
 627                         track->set_position(pos);
 628                         track->set_rotation(dir);
 629
 630                         if(!trks.empty())
 631                                 track->snap_to(*trks.back(), true);
 632                         trks.push_back(track);
 633
 634                         pos.x += c**i;
 635                         pos.y += s**i;
 636                 }
 637         }
 638
 639         return trks;
 640 }
 641
 642
 643 Manipulator::MTrack::MTrack(Track *t):
 644         track(t),
 645         pos(track->get_position()),
 646         rot(track->get_rotation())
 647 { }