Line data Source code
1 : /****************************************************************************/
2 : // Eclipse SUMO, Simulation of Urban MObility; see https://eclipse.dev/sumo
3 : // Copyright (C) 2001-2025 German Aerospace Center (DLR) and others.
4 : // This program and the accompanying materials are made available under the
5 : // terms of the Eclipse Public License 2.0 which is available at
6 : // https://www.eclipse.org/legal/epl-2.0/
7 : // This Source Code may also be made available under the following Secondary
8 : // Licenses when the conditions for such availability set forth in the Eclipse
9 : // Public License 2.0 are satisfied: GNU General Public License, version 2
10 : // or later which is available at
11 : // https://www.gnu.org/licenses/old-licenses/gpl-2.0-standalone.html
12 : // SPDX-License-Identifier: EPL-2.0 OR GPL-2.0-or-later
13 : /****************************************************************************/
14 : /// @file Position.cpp
15 : /// @author Daniel Krajzewicz
16 : /// @author Jakob Erdmann
17 : /// @author Axel Wegener
18 : /// @author Michael Behrisch
19 : /// @date Sept 2002
20 : ///
21 : // A position in the 2D- or 3D-world
22 : /****************************************************************************/
23 : #include <config.h>
24 :
25 : #include <limits>
26 : #include "GeomHelper.h"
27 : #include "Position.h"
28 :
29 :
30 : // ===========================================================================
31 : // static member definitions
32 : // ===========================================================================
33 :
34 : // Position 1Mio km below the surface should suffice for signaling invalidity inside the solar system
35 : const Position Position::INVALID(
36 : - 1024 * 1024 * 1024,
37 : - 1024 * 1024 * 1024,
38 : - 1024 * 1024 * 1024);
39 :
40 :
41 : Position
42 11595142 : Position::rotateAround2D(double rad, const Position& origin) {
43 11595142 : const double s = sin(rad);
44 11595142 : const double c = cos(rad);
45 : Position p = (*this) - origin;
46 11595142 : return Position(
47 11595142 : p.x() * c - p.y() * s,
48 11595142 : p.x() * s + p.y() * c) + origin;
49 :
50 : }
51 :
52 : void
53 417984 : Position::round(int precision) {
54 : // bankers rounding as in iostream
55 417984 : myX = roundDecimalToEven(myX, precision);
56 417984 : myY = roundDecimalToEven(myY, precision);
57 417984 : myZ = roundDecimalToEven(myZ, precision);
58 417984 : }
|