|
@@ -302,7 +302,8 @@ void createosgbox()
|
|
|
|
|
|
int SetupADCIVCar( viewer::Viewer *viewer)
|
|
int SetupADCIVCar( viewer::Viewer *viewer)
|
|
{
|
|
{
|
|
- int carModelID = 2;
|
|
|
|
|
|
+// int carModelID = 2;
|
|
|
|
+ int carModelID = 0;
|
|
Car *car_ = new Car;
|
|
Car *car_ = new Car;
|
|
// Higher speeds in lanes closer to reference lane
|
|
// Higher speeds in lanes closer to reference lane
|
|
car_->speed_factor = 0.5 ; // Speed vary between 0.5 to 1.0 times default speed
|
|
car_->speed_factor = 0.5 ; // Speed vary between 0.5 to 1.0 times default speed
|
|
@@ -313,8 +314,8 @@ int SetupADCIVCar( viewer::Viewer *viewer)
|
|
// car_->pos->SetHeadingRelative(lane->GetId() < 0 ? 0 : M_PI);
|
|
// car_->pos->SetHeadingRelative(lane->GetId() < 0 ? 0 : M_PI);
|
|
// car_->heading_init = car_->pos->GetHRelative();
|
|
// car_->heading_init = car_->pos->GetHRelative();
|
|
|
|
|
|
- viewer->AddOSGBEnv("/home/nvidia/xin_beijing_xiali0716.opt.osgb",osg::Vec3(0.5, 0.5, 0.5),"env");
|
|
|
|
- viewer->AddOSGBEnv("/home/nvidia/xin_beijing_xiali0716.shadow.osgb",osg::Vec3(0.5, 0.5, 0.5),"env1");
|
|
|
|
|
|
+// viewer->AddOSGBEnv("/home/nvidia/xiali_fangzhen.opt.osgb",osg::Vec3(1.0, 1.0, 1.0),"env");
|
|
|
|
+// viewer->AddOSGBEnv("/home/nvidia/xiali_fangzhen.shadow.osgb",osg::Vec3(0.5, 0.5, 0.5),"env1");
|
|
|
|
|
|
if ((car_->model = viewer->AddEntityModel(carModelsFiles_[carModelID], osg::Vec3(0.5, 0.5, 0.5),
|
|
if ((car_->model = viewer->AddEntityModel(carModelsFiles_[carModelID], osg::Vec3(0.5, 0.5, 0.5),
|
|
viewer::EntityModel::EntityType::ENTITY_TYPE_VEHICLE, false, "", 0)) == 0)
|
|
viewer::EntityModel::EntityType::ENTITY_TYPE_VEHICLE, false, "", 0)) == 0)
|
|
@@ -632,6 +633,7 @@ int main(int argcx, char** argvx)
|
|
argv[2] = "/home/nvidia/map/map.xodr";
|
|
argv[2] = "/home/nvidia/map/map.xodr";
|
|
|
|
|
|
std::string mappath = getenv("HOME");
|
|
std::string mappath = getenv("HOME");
|
|
|
|
+// mappath = mappath + "/map/mapa.xodr";
|
|
mappath = mappath + "/map/map.xodr";
|
|
mappath = mappath + "/map/map.xodr";
|
|
argv[2] = new char[256];
|
|
argv[2] = new char[256];
|
|
strncpy(argv[2],mappath.c_str(),256);
|
|
strncpy(argv[2],mappath.c_str(),256);
|
|
@@ -648,7 +650,7 @@ int main(int argcx, char** argvx)
|
|
std::string strgpsmsg = xp.GetParam("gpsmsg","hcp2_gpsimu");
|
|
std::string strgpsmsg = xp.GetParam("gpsmsg","hcp2_gpsimu");
|
|
std::string strradarmsg = xp.GetParam("radarmsg","radar");
|
|
std::string strradarmsg = xp.GetParam("radarmsg","radar");
|
|
std::string strcnnmsg = xp.GetParam("cnnmsg","lidar_track");
|
|
std::string strcnnmsg = xp.GetParam("cnnmsg","lidar_track");
|
|
- std::string strheightajust = xp.GetParam("heightajust","-1.0");
|
|
|
|
|
|
+ std::string strheightajust = xp.GetParam("heightajust","-1.6");
|
|
gvehicleheight = atof(strheightajust.data());
|
|
gvehicleheight = atof(strheightajust.data());
|
|
|
|
|
|
|
|
|
|
@@ -746,11 +748,11 @@ int main(int argcx, char** argvx)
|
|
|
|
|
|
try
|
|
try
|
|
{
|
|
{
|
|
-// if (!roadmanager::Position::LoadOpenDrive(odrFilename.c_str()))
|
|
|
|
-// {
|
|
|
|
-// printf("Failed to load ODR %s\n", odrFilename.c_str());
|
|
|
|
-// return -1;
|
|
|
|
-// }
|
|
|
|
|
|
+ if (!roadmanager::Position::LoadOpenDrive(odrFilename.c_str()))
|
|
|
|
+ {
|
|
|
|
+ printf("Failed to load ODR %s\n", odrFilename.c_str());
|
|
|
|
+ return -1;
|
|
|
|
+ }
|
|
roadmanager::OpenDrive *odrManager = roadmanager::Position::GetOpenDrive();
|
|
roadmanager::OpenDrive *odrManager = roadmanager::Position::GetOpenDrive();
|
|
|
|
|
|
osg::ArgumentParser arguments(&argc, argv);
|
|
osg::ArgumentParser arguments(&argc, argv);
|
|
@@ -788,8 +790,9 @@ int main(int argcx, char** argvx)
|
|
viewer->GetNodeMaskBit(viewer::NodeMask::NODE_MASK_OSI_POINTS) ? "on" : "off");
|
|
viewer->GetNodeMaskBit(viewer::NodeMask::NODE_MASK_OSI_POINTS) ? "on" : "off");
|
|
|
|
|
|
SetupADCIVCar(viewer);
|
|
SetupADCIVCar(viewer);
|
|
- SetupRadar(viewer);
|
|
|
|
|
|
+// SetupRadar(viewer);
|
|
SetupLidar(viewer);
|
|
SetupLidar(viewer);
|
|
|
|
+ viewer->AddBackModel(osg::Vec3(0.5, 0.5, 0.5),"");
|
|
// gtestRadar = viewer->AddRadarModel(osg::Vec3(0.5, 0.5, 0.5),"");
|
|
// gtestRadar = viewer->AddRadarModel(osg::Vec3(0.5, 0.5, 0.5),"");
|
|
// gtestRadar = viewer->AddEntityModel(carModelsFiles_[0], osg::Vec3(0.5, 0.5, 0.5),
|
|
// gtestRadar = viewer->AddEntityModel(carModelsFiles_[0], osg::Vec3(0.5, 0.5, 0.5),
|
|
// viewer::EntityModel::EntityType::ENTITY_TYPE_VEHICLE, false, "", 0);
|
|
// viewer::EntityModel::EntityType::ENTITY_TYPE_VEHICLE, false, "", 0);
|