|
@@ -19,6 +19,13 @@ namespace iv {
|
|
double gps_y = 0;
|
|
double gps_y = 0;
|
|
double gps_z = 0;
|
|
double gps_z = 0;
|
|
|
|
|
|
|
|
+ double frenet_s=0;
|
|
|
|
+ double frenet_s_dot=0;
|
|
|
|
+ double frenet_s_dot_dot=0;
|
|
|
|
+ double frenet_d=0;
|
|
|
|
+ double frenet_d_dot=0;
|
|
|
|
+ double frenet_d_dot_dot=0;
|
|
|
|
+
|
|
double ins_roll_angle = 0; //横滚角 一般定义载体的右、前、上三个方向构成右手系,绕向前的轴旋转就是横滚角,绕向右的轴旋转就是俯仰角,绕向上的轴旋转就是航向角
|
|
double ins_roll_angle = 0; //横滚角 一般定义载体的右、前、上三个方向构成右手系,绕向前的轴旋转就是横滚角,绕向右的轴旋转就是俯仰角,绕向上的轴旋转就是航向角
|
|
double ins_pitch_angle = 0; //俯仰角
|
|
double ins_pitch_angle = 0; //俯仰角
|
|
double ins_heading_angle = 0; //航向角
|
|
double ins_heading_angle = 0; //航向角
|
|
@@ -75,24 +82,38 @@ namespace iv {
|
|
int mnreserved[5];
|
|
int mnreserved[5];
|
|
double mfreserved[2];
|
|
double mfreserved[2];
|
|
|
|
|
|
|
|
+
|
|
|
|
+
|
|
};
|
|
};
|
|
|
|
|
|
typedef boost::shared_ptr<iv::GPS_INS> GPSData;
|
|
typedef boost::shared_ptr<iv::GPS_INS> GPSData;
|
|
- class Point2D
|
|
|
|
- {
|
|
|
|
- public:
|
|
|
|
- double x = 0, y = 0, speed=0;
|
|
|
|
- int v1 = 0, v2 = 0;
|
|
|
|
-
|
|
|
|
- Point2D()
|
|
|
|
- {
|
|
|
|
- x = y = v1 = 0;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- Point2D(double _x, double _y)
|
|
|
|
- {
|
|
|
|
- x = _x; y = _y;
|
|
|
|
- }
|
|
|
|
- };
|
|
|
|
|
|
+ class Point2D
|
|
|
|
+ {
|
|
|
|
+ public:
|
|
|
|
+ double x = 0, y = 0, speed=0,obs_speed_x=0,obs_speed_y=0;
|
|
|
|
+ int v1 = 0, v2 = 0;
|
|
|
|
+ int roadMode = 0;
|
|
|
|
+ int obs_type=0;
|
|
|
|
+
|
|
|
|
+ double s=0; //frenet coordinate : s,d; add at 20220209
|
|
|
|
+ double d=0;
|
|
|
|
+
|
|
|
|
+
|
|
|
|
+ Point2D()
|
|
|
|
+ {
|
|
|
|
+ x = y = v1 = 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ Point2D(double _x, double _y)
|
|
|
|
+ {
|
|
|
|
+ x = _x; y = _y;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+
|
|
|
|
+ };
|
|
|
|
+
|
|
|
|
+
|
|
|
|
+
|
|
|
|
+
|
|
}
|
|
}
|
|
#endif // !_IV_COMMON_GPS_TYPE_
|
|
#endif // !_IV_COMMON_GPS_TYPE_
|