示例#1
0
文件: gazebo.cpp 项目: dennisss/tansa
void gazebo_stats_callback(ConstWorldStatisticsPtr &msg) {
	Time t(msg->sim_time().sec(), msg->sim_time().nsec());
	Time rt(msg->real_time().sec(), msg->real_time().nsec());

//	Time rt = Time::realNow();
//	if(gazebo_registered) {
	Time::setTime(t, t.seconds() / rt.seconds());
//	}

//	gazebo_last_time =
}
void cb2(ConstWorldStatisticsPtr &_msg)
{
	std_msgs::Float64 realtime, simtime,nanosec;
	
	realtime.data=_msg->real_time().sec();
	//nanosec.data=_msg->real_time().nsec();   	
	simtime.data=_msg->sim_time().sec();
	
    pub2.publish(realtime);
    pub3.publish(simtime);
    //pub4.publish(nanosec);
}