X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Fsignal.cpp;h=a25f8eca4697fde499b993348a32a4de7f20e752;hb=bde934f7d5ba07a9442a305192e10024820d13ed;hp=650c36232e87d82559fc36cfbb6aba2bc160ab55;hpb=b88d3630a0e3fdd763db018bbe5dbfe3180a95f2;p=r2c2.git diff --git a/source/libr2c2/signal.cpp b/source/libr2c2/signal.cpp index 650c362..a25f8ec 100644 --- a/source/libr2c2/signal.cpp +++ b/source/libr2c2/signal.cpp @@ -80,12 +80,8 @@ void Signal::normalize_location() unsigned n_endpoints = track->get_type().get_endpoints().size(); for(unsigned j=0; jget_snap_node(j).rotation-rotation; - while(a<-M_PI/2) - a += M_PI*2; - while(a>M_PI*3/2) - a -= M_PI*2; - if(a>=M_PI/2) + Angle a = wrap_with_base(track->get_snap_node(j).rotation-rotation, -Angle::quarter_turn()); + if(a>=Angle::quarter_turn()) { BlockIter biter = TrackIter(track, j).block_iter(); entry = biter.entry(); @@ -93,19 +89,11 @@ void Signal::normalize_location() } } -void Signal::set_rotation(float r) +void Signal::set_rotation(const Angle &r) { - float a = rotation-r; - while(a>M_PI*3/2) - a -= M_PI*2; - while(a<-M_PI/2) - a += M_PI*2; - if(a>=M_PI/2) - { - rotation += M_PI; - if(rotation>M_PI*2) - rotation -= M_PI*2; - } + Angle a = wrap_with_base(rotation-r, -Angle::quarter_turn()); + if(a>=Angle::quarter_turn()) + rotation = wrap_positive(rotation+Angle::half_turn()); normalize_location(); } @@ -134,20 +122,6 @@ SnapType Signal::get_default_snap_type_to(const Object &other) const return NO_SNAP; } -bool Signal::collide_ray(const Vector &start, const Vector &ray) const -{ - // XXX Totally hardcoded stuff, should be replaced with a geometry system - Vector center = position; - center.x += sin(rotation)*0.035; - center.y -= cos(rotation)*0.035; - Vector d(center.x-start.x, center.y-start.y); - float x = (d.x*ray.x+d.y*ray.y)/(ray.x*ray.x+ray.y*ray.y); - Vector nearest(start.x+ray.x*x-center.x, start.y+ray.y*x-center.y, start.z+ray.z*x-center.z); - if(nearest.z<0|| nearest.z>0.12) - return false; - return nearest.x*nearest.x+nearest.y*nearest.y<0.0001; -} - void Signal::tick(const Time::TimeDelta &) { if(check_allocated_blocks) @@ -225,7 +199,7 @@ void Signal::reset() void Signal::save(list &st) const { st.push_back((DataFile::Statement("position"), position.x, position.y, position.z)); - st.push_back((DataFile::Statement("rotation"), rotation)); + st.push_back((DataFile::Statement("rotation"), rotation.radians())); if(address) st.push_back((DataFile::Statement("address"), address)); } @@ -251,7 +225,7 @@ void Signal::Loader::position(float x, float y, float z) void Signal::Loader::rotation(float d) { - obj.set_rotation(d); + obj.set_rotation(Angle::from_radians(d)); } } // namespace R2C2