diff options
Diffstat (limited to 'src/control/PathFind.cpp')
-rw-r--r-- | src/control/PathFind.cpp | 41 |
1 files changed, 22 insertions, 19 deletions
diff --git a/src/control/PathFind.cpp b/src/control/PathFind.cpp index af4754b9..3c16202b 100644 --- a/src/control/PathFind.cpp +++ b/src/control/PathFind.cpp @@ -794,10 +794,11 @@ CPathFind::SwitchRoadsOffInArea(float x1, float x2, float y1, float y2, float z1 { int i; - for(i = 0; i < m_numPathNodes; i++) - if(x1 < m_pathNodes[i].pos.x && m_pathNodes[i].pos.x < x2 && - y1 < m_pathNodes[i].pos.y && m_pathNodes[i].pos.y < y2 && - z1 < m_pathNodes[i].pos.z && m_pathNodes[i].pos.z < z2) + for(i = 0; i < m_numCarPathNodes; i++) + if (x1 <= m_pathNodes[i].pos.x && m_pathNodes[i].pos.x <= x2 && + y1 <= m_pathNodes[i].pos.y && m_pathNodes[i].pos.y <= y2 && + z1 <= m_pathNodes[i].pos.z && m_pathNodes[i].pos.z <= z2 && + disable != m_pathNodes[i].bDisabled) SwitchOffNodeAndNeighbours(i, disable); } @@ -807,19 +808,21 @@ CPathFind::SwitchPedRoadsOffInArea(float x1, float x2, float y1, float y2, float int i; for(i = m_numCarPathNodes; i < m_numPathNodes; i++) - if(x1 < m_pathNodes[i].pos.x && m_pathNodes[i].pos.x < x2 && - y1 < m_pathNodes[i].pos.y && m_pathNodes[i].pos.y < y2 && - z1 < m_pathNodes[i].pos.z && m_pathNodes[i].pos.z < z2) + if(x1 <= m_pathNodes[i].pos.x && m_pathNodes[i].pos.x <= x2 && + y1 <= m_pathNodes[i].pos.y && m_pathNodes[i].pos.y <= y2 && + z1 <= m_pathNodes[i].pos.z && m_pathNodes[i].pos.z <= z2 && + disable != m_pathNodes[i].bDisabled) SwitchOffNodeAndNeighbours(i, disable); } void -CPathFind::SwitchRoadsInAngledArea(float x1, float y1, float z1, float x2, float y2, float z2, float length, uint8 type, uint8 enable) +CPathFind::SwitchRoadsInAngledArea(float x1, float y1, float z1, float x2, float y2, float z2, float length, uint8 type, uint8 mode) { int i; int firstNode, lastNode; - if(type == PATH_CAR){ + // this is NOT PATH_CAR + if(type != 0){ firstNode = 0; lastNode = m_numCarPathNodes; }else{ @@ -828,25 +831,25 @@ CPathFind::SwitchRoadsInAngledArea(float x1, float y1, float z1, float x2, float } if(z1 > z2){ - float tmp = z1; - z1 = z2; - z2 = tmp; + float tmp = z2; + z2 = z1; + z1 = tmp; } // angle of vector from p2 to p1 float angle = CGeneral::GetRadianAngleBetweenPoints(x1, y1, x2, y2) + HALFPI; - while(angle < TWOPI) angle += TWOPI; + while(angle < 0.0f) angle += TWOPI; while(angle > TWOPI) angle -= TWOPI; // vector from p1 to p2 CVector2D v12(x2 - x1, y2 - y1); float len12 = v12.Magnitude(); - CVector2D vn12 = v12/len12; + v12 /= len12; + // vector from p2 to new point p3 - CVector2D v23(-Sin(angle)*length, Cos(angle)*length); - float len23 = v23.Magnitude(); // obivously just 'length' but whatever - CVector2D vn23 = v23/len23; + CVector2D v23(Sin(angle)*length, -(Cos(angle)*length)); + v23 /= v23.Magnitude(); // obivously just 'length' but whatever - bool disable = !enable; + bool disable = mode == SWITCH_OFF; for(i = firstNode; i < lastNode; i++){ if(m_pathNodes[i].pos.z < z1 || m_pathNodes[i].pos.z > z2) continue; @@ -855,7 +858,7 @@ CPathFind::SwitchRoadsInAngledArea(float x1, float y1, float z1, float x2, float if(dot < 0.0f || dot > len12) continue; dot = DotProduct2D(d, v23); - if(dot < 0.0f || dot > len23) + if(dot < 0.0f || dot > length) continue; if(m_pathNodes[i].bDisabled != disable) SwitchOffNodeAndNeighbours(i, disable); |