mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-19 09:13:33 +08:00
added a messageplayer prototype for ros
This commit is contained in:
@@ -45,7 +45,8 @@ using namespace px4;
|
||||
|
||||
PublisherExample::PublisherExample() :
|
||||
_n(),
|
||||
_rc_channels_pub(PX4_ADVERTISE(_n, rc_channels))
|
||||
_rc_channels_pub(_n.advertise<px4_rc_channels>())
|
||||
// _rc_channels_pub(PX4_ADVERTISE(_n, rc_channels))
|
||||
{
|
||||
|
||||
}
|
||||
@@ -55,11 +56,19 @@ int PublisherExample::main()
|
||||
px4::Rate loop_rate(10);
|
||||
|
||||
while (px4::ok()) {
|
||||
PX4_TOPIC_T(rc_channels) msg;
|
||||
msg.timestamp_last_valid = px4::get_time_micros();
|
||||
PX4_INFO("%llu", msg.timestamp_last_valid);
|
||||
// PX4_TOPIC_T(rc_channels) msg;
|
||||
// msg.timestamp_last_valid = px4::get_time_micros();
|
||||
// PX4_INFO("%llu", msg.timestamp_last_valid);
|
||||
|
||||
// _rc_channels_pub->publish(msg);
|
||||
|
||||
//XXX
|
||||
px4_rc_channels msg2;
|
||||
msg2.data().timestamp_last_valid = px4::get_time_micros();
|
||||
PX4_INFO("%llu", msg2.data().timestamp_last_valid);
|
||||
// msg2.pub->publish2();
|
||||
_rc_channels_pub->publish(msg2);
|
||||
|
||||
_rc_channels_pub->publish(msg);
|
||||
|
||||
_n.spinOnce();
|
||||
loop_rate.sleep();
|
||||
|
||||
@@ -48,5 +48,6 @@ public:
|
||||
int main();
|
||||
protected:
|
||||
px4::NodeHandle _n;
|
||||
// px4::Publisher<px4::px4_rc_channels> * _rc_channels_pub;
|
||||
px4::Publisher * _rc_channels_pub;
|
||||
};
|
||||
|
||||
Reference in New Issue
Block a user