11.. _first field coordinate system :
22
3- *FIRST * Tech Challenge Field “Coordinate System" Definition
4- ===========================================================
3+ *FIRST * Tech Challenge Field Coordinate System Definition
4+ =========================================================
5+
6+ .. meta ::
7+ :description: This document defines the FIRST Tech Challenge Field Coordinate System which can be used to specify position on the playing field.
8+
9+ Summary: The *FIRST * Tech Challenge Field Coordinate System is a Cartesian Coordinate System of three dimensions.
10+ The X and Y axes will refer to a position on the field and the Z axis a height above the field.
511
612Scope
713-----
8-
9- This document defines the “standard” Coordinate System (orthogonal axes)
10- definition for a *FIRST * Tech Challenge playing field. This definition can be
14+
15+ This document defines the Field Coordinate System
16+ for a *FIRST * Tech Challenge playing field. This definition can be
1117used for consistent field-centric navigation, target localization and path
1218planning.
1319
14- Reference frame
20+ Reference Frame
1521---------------
1622
1723The reference frame for this definition is the field perimeter wall, adjacent
18- to the RED Alliance Station ( known here as the: RED WALL) . The definition is
24+ to the red Alliance Area, known here after as the Red Wall . The definition is
1925from the perspective of a person, standing outside the field, in the center of
20- RED WALL, looking towards the center of the field.
21-
22- Caveat: If the Red Alliance Station is ever adjacent to two perimeter walls,
23- the RED WALL will be the one with *most * contact with the Alliance Station. If
24- the red Alliance Station is ever adjacent to two perimeter walls EQUALLY, then
25- the most clockwise of the two walls will be considered to be the RED WALL.
26+ Red Wall, looking towards the center of the field.
27+
28+ .. note ::
29+ If the red Alliance Area is ever adjacent to two perimeter walls,
30+ the Red Wall will be the one with *most * contact with the Alliance Area. If
31+ the red Alliance Area is ever adjacent to two perimeter walls *equally *, then
32+ the most clockwise of the two walls will be considered to be the Red Wall.
33+
34+ Coordinate System
35+ -----------------
36+
37+ The Field Coordinate System is a Cartesian Coordinate System of three dimensions.
38+ X and Y will refer to a position on the field.
39+ Z will refer to a height above the field.
40+ You may use any length measure as long as the same measure is used for all three axes.
41+ The coordinates are ordered (X, Y, Z).
42+ Example: coordinate position (10, -10, 0) has X = 10, Y = -10 and Z = 0.
2643
2744Origin
2845^^^^^^
@@ -35,85 +52,131 @@ mat.
3552X Axis
3653^^^^^^
3754
38- Looking at the origin from the RED WALL , the X axis extends through the origin
39- point and runs to the right and left, parallel with the RED WALL . The X axis
55+ Looking at the origin from the Red Wall , the X axis extends through the origin
56+ point and runs to the right and left, parallel with the Red Wall . The X axis
4057values increase to the right.
4158
4259Y Axis
4360^^^^^^
4461
45- Looking at the origin from the RED WALL , the Y axis extends through the origin
46- point and runs out and in, perpendicular to the RED WALL. Increasing Y values
47- run out (away) from the RED WALL .
62+ Looking at the origin from the Red Wall , the Y axis extends through the origin
63+ point and runs out and in, perpendicular to the Red Wall. Increasing Y values
64+ run out (away) from the Red Wall .
4865
4966Z Axis
5067^^^^^^
5168
52- Looking at the origin from the RED WALL , the Z axis extends through the origin
69+ Looking at the origin from the Red Wall , the Z axis extends through the origin
5370point and runs up and down in a vertical line. Increasing Z values extend
5471upwards.
5572
56- Rotation about Axes
73+ Rotation About Axes
5774^^^^^^^^^^^^^^^^^^^
5875
5976When considering rotations about an axis, consider yourself looking down the
60- (positive) axis of rotation from the positive towards the origin. Positive
61- rotations are then CCW, and negative rotations CW .
62-
77+ axis from the positive end towards the origin. Positive
78+ rotations are then counterclockwise and negative rotations clockwise .
79+
6380.. figure :: images/image1.jpg
64- :width: 35%
65- :align: center
66- :alt: Coordinate Axes
67-
68- Figure 1: Coordinate Axes
81+ :alt: X, Y and Z coordinate axes.
82+
83+ Counterclockwise rotations about each axis
84+
85+ Imagine looking down the positive Z axis towards the origin.
86+ This would be like standing in the middle of the field looking down.
87+ A positive rotation about the Z axis would be counterclockwise.
6988
70- An example: consider looking down the positive Z axis towards the origin. This
71- would be like standing in the middle of the field, looking down. A positive
72- rotation about Z (i.e. a rotation parallel to the X-Y plane) is then CCW, as
73- one would normally expect from the usual classic 2D geometry.
89+ Example: a robot spinning clockwise on the Field is making a negative rotation about the Z axis.
7490
75- Examples
76- --------
91+ Field Configuration Examples
92+ ----------------------------
7793
78- Below are two examples illustrating this Axes definition.
94+ Below are two examples illustrating the Field Coordinate System for different
95+ *FIRST * Tech Challenge field configurations.
7996
8097.. note ::
81- Note that in both cases the Red Alliance members are facing out,
82- along the positive Y axis.
83-
84- However, in the “Diamond” field configuration, the X axis is pointing
85- towards the Blue Alliance, but in the “Square” field configuration
86- the Y axis is pointing towards the Blue Alliance.
87-
88-
89- .. figure :: images/image2.jpg
90- :width: 75%
91- :align: center
92- :alt: RES-Q
93-
94- Figure 2: FIRST Tech Challenge RES-Q game field orientation
95-
96- .. figure :: images/image3.jpg
97- :width: 75%
98- :align: center
99- :alt: Cascade Effect
100-
101- Figure 3: FIRST Tech Challenge Cascade Effect game field orientation
98+ In both field configurations the red Alliance is facing out along the positive Y axis,
99+ and the Z axis points up from the center of the field.
100+
101+ Diamond Field
102+ ^^^^^^^^^^^^^
103+
104+ .. figure :: images/first-res-q-field.png
105+ :alt: A diamond field with X, Y and Z axes shown.
106+
107+ The FIRST RES-Q game field
108+
109+ In a diamond field configuration the two Alliance walls are adjacent.
110+ The field is rotated 45 degrees such that both Alliances face the audience.
111+ From the audience perspective the field forms a diamond shape.
112+ The Red Wall will be on the right as seen from the audience.
113+ The Y axis points across the field as seen from the Red Wall.
114+ The X axis points to the Blue Alliance.
115+
116+ Square Field
117+ ^^^^^^^^^^^^
118+
119+ .. figure :: images/into-the-deep-field.png
120+ :alt: A square field with X, Y and Z axes shown.
121+
122+ The Into The Deep game field
123+
124+ In a square field configuration the two Alliances face each other across the field.
125+ The field is oriented such that the Red Wall is on the right as seen from the audience.
126+ The Y axis points across the field from the Red Wall towards the Blue Alliance.
127+ The X axis points away from the audience to the rear of the field.
128+
129+ Coordinate Position Example
130+ ---------------------------
131+
132+ Let's consider the coordinates (0, -24, 26) in inches on the Into The Deep field, which is a square field.
133+ Given the order of coordinates then X = 0, Y = -24, and Z = 26.
134+
135+ The X axis value of 0 is located at the origin in the center of the field.
136+ The Y axis value of negative 24 would be located closer to the Red Wall, away from the origin by the width of one tile.
137+ This the center of the wall of the submersible structure on the red side of the field.
138+
139+ The Z axis value of 26 indicates the coordinates refer to the center and top of the Red Alliance "high chamber"
140+ (which is the higher of the two red crossbars).
102141
103142Measured Values
104143---------------
105144
106- The following values have been measured from a 2016 competition field. They are
145+ The following metric values have been measured from a 2016 competition field. They are
107146representative only, and should not be assumed to be exact, or guaranteed.
108147
109- - Distance between opposite inside faces of panels: 3580 mm
110- (if field assembled well: the straps give some adjustment tolerance)
148+ - Distance between opposite inside faces of panels: 3580 mm,
149+ (if the field is assembled well: the straps give some adjustment tolerance)
111150- Polycarbonate transparencies have a visible opening height of 255 mm
112151- The top edge of transparencies is 30 mm from the top of the perimeter
113152- Total perimeter height is 313 mm
114- - Tiles are 13mm thick
153+ - Tiles are 13 mm thick
115154
116155So, for a diamond field configuration, the corner of the field closest to the
117156audience, at a height equal to the top of the perimeter wall, would have a
118- coordinate position of: (-1790, 1790, 300).
157+ coordinate position of: (-1790, 1790, 300) in millimeters.
158+
159+ Additional Information
160+ ----------------------
161+
162+ See this Wikipedia article on `Cartesian coordinate system
163+ <https://en.wikipedia.org/wiki/Cartesian_coordinate_system#Three_dimensions> `__
164+ in three dimensions.
165+ The Field Coordinate System rotation convention comes from the
166+ `right hand rule <https://en.wikipedia.org/wiki/Right-hand_rule >`__
167+ of classic geometry.
168+
169+ Robots with a webcam can use :ref: `AprilTags <apriltag/vision_portal/apriltag_intro/apriltag-intro:apriltag introduction >`
170+ to determine where an :ref: `AprilTag is located
171+ <apriltag/understanding_apriltag_detection_values/understanding-apriltag-detection-values:introduction>`
172+ with respect to the robot.
173+ Since AprilTags are in known locations on the field, you can also determine the
174+ :ref: `location of the robot <apriltag/vision_portal/apriltag_localization/apriltag-localization:apriltag localization >`
175+ on the field.
176+
177+ Robots can use an inertial measurement unit (IMU) to measure rotations about axes
178+ with respect to the robot. See :ref: `IMU axes definition. <programming_resources/imu/imu:axes definition >`
179+ The yaw value from the IMU, also known the heading, measures rotation about the Z axis
180+ which points up from the robot.
181+ You can use the IMU to determine which direction a robot is facing.
119182
0 commit comments