Getting ros2 time to stamp the PoseStamped message

56 views (last 30 days)
I work with a ros2 system in which my algorithm sends as an output a navigation message using the geometry_msgs/PoseStamped. The problem is that I want to assign the time stamp parameter with the value of ros2 time and the only function available for that is rostime("now") which works only with ros not ros2 that's why I get the error:
The global ROS node is not initialized. Use "rosinit" to start the global node and connect to a ROS network.
So I'm looking for a solution to get the time of ros2 or find a way to make the system time in a format of the time stamp of the output message.
That is the code I'm using to assign the output message:
msg= ros2message("geometry_msgs/PoseStamped");
msg.pose.position.x=pos(1); %pos is a variable assigned previously in the code
msg.pose.position.y=pos(2);
msg.pose.position.z=0;
msg.orientation.x=0;
msg.orientation.y=0;
msg.orientation.z=theta;
msg.orientation.w=1;
[s,ns]= getTime; %getTime Function
GNSSmsg.header.stamp.sec=s;
GNSSmsg.header.stamp.nanosec=ns;
%getTime Function:
function [s,ns] = getTime
t = rostime('now');
s = t.Sec;
ns = t.Nsec;
end

Answers (2)

Cam Salzberger
Cam Salzberger on 4 Aug 2022
Hello Samantha,
I don't have MATLAB in front of me to check, but if you want to use system time, I think using datetime and convertTo would be easier than starting a ROS Master:
currTime = datetime("now");
currTimePosix = convertTo(currTime, "posixtime");
sec = floor(currTimePosix);
nsec = round((currTimePosix-sec)*1e9);
msg.sec = sec;
msg.nsec = nsec
msg = struct with fields:
sec: 1.6596e+09 nsec: 834337950
-Cam

Josh Chen
Josh Chen on 4 Apr 2024 at 12:41
Hi Samantha,
We introduced ros2time since R2022b.
If you are looking for a ROS 2 equivalent for getting timestamp and you are working with MATLAB/Simulink version at or after R2022b, I would recommand to use ros2time. This allows you to not only use system time, but also, time from "/use_sim_time" topic.
Thanks,
Josh

Products

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!