function
sysCall_init()
visionSensor=sim.getObject(
'/Vision_sensor'
)
pub=simROS2.createPublisher(
'/image'
,
'sensor_msgs/msg/Image'
)
simROS2.publisherTreatUInt8ArrayAsString(pub)
end
function
sysCall_sensing()
local
img,resolution=sim.getVisionSensorImg(visionSensor)
data={}
data.header={stamp=simROS2.getTime(), frame_id=
'a'
}
data.height=resolution[2]
data.width=resolution[1]
data.encoding=
'rgb8'
data.is_bigendian=1
data.step=resolution[1]*3
data.data=img
simROS2.publish(pub,data)
end
function
sysCall_cleanup()
simROS2.shutdownPublisher(pub)
end