接上面 ROS入门,因为内容太多另起一篇
下面只使用C++ 而不使用Python(与自动化专业贴近)
-----------------------------------------------------------------------------------------------------
一。初始化
- void init(int &argc, char **argv, const std::string& name, uint32_t options = 0);
- // 最后一个参数是可选的
- /** ROS初始化函数。
- *
- * 该函数可以解析并使用节点启动时传入的参数(通过参数设置节点名称、命名空间...)
- *
- * 该函数有多个重载版本,如果使用NodeHandle建议调用该版本。
- *
- * \param argc 参数个数
- * \param argv 参数列表
- * \param name 节点名称,需要保证其唯一性,不允许包含命名空间
- * \param options 节点启动选项,被封装进了ros::init_options
- *
- */
-
--------------------------------------------------------------------------------
二。话题与话题服务函数
在 roscpp 中,话题和服务的相关对象一般由 NodeHandle 创建,NodeHandle有一个重要作用是可以用于设置命名空间。
1. 发布对象
Publisher advertise(const std::string& topic, uint32_t queue_size, bool latch = false)
ros::Publisher pub = nh.advertise<std_msgs::String>("chatter",10);
ros::Publisher pub = handle.advertise<std_msgs::Empty>("my_topic", 1);
- /**
- * \brief 根据话题生成发布对象
- *
- * 在 ROS master 注册并返回一个发布者对象,该对象可以发布消息
- *
- * 使用示例如下:
- *
- * ros::Publisher pub = handle.advertise<std_msgs::Empty>("my_topic", 1);
- *
- * \param topic 发布消息使用的话题
- *
- * \param queue_size 等待发送给订阅者的最大消息数量
- *
- * \param latch (optional) 如果为 true,该话题发布的最后一条消息将被保存,并且后期当有订阅者连接时会将该消息发送给订阅者
- *
- * \return 调用成功时,会返回一个发布对象
- *
- *
- */
2. 订阅对象
-
- void doMsg(const std_msgs::String::ConstPtr& msg_p){
- ROS_INFO("我听见:%s",msg_p->data.c_str());
- // ROS_INFO("我听见:%s",(*msg_p).data.c_str());
- }
ros::Subscriber sub = nh.subscribe<std_msgs::String>("chatter",10,doMsg);
- /**
- * \brief 生成某个话题的订阅对象
- *
- * 该函数将根据给定的话题在ROS master 注册,并自动连接相同主题的发布方,每接收到一条消息,都会调用回调
- * 函数,并且传入该消息的共享指针,该消息不能被修改,因为可能其他订阅对象也会使用该消息。
-
- * \param M [template] M 是指消息类型
- * \param topic 订阅的话题
- * \param queue_size 消息队列长度,超出长度时,头部的消息将被弃用
- * \param fp 当订阅到一条消息时,需要执行的回调函数
- * \return 调用成功时,返回一个订阅者对象,失败时,返回空对象
3. 服务对象
为自己所定义内容,服务通信 ---- 有一些前置步骤,需要参考一下ROS入门
-
- bool doReq(demo03_server_client::AddInts::Request& req,
- demo03_server_client::AddInts::Response& resp){
- int num1 = req.num1;
- int num2 = req.num2;
-
- ROS_INFO("服务器接收到的请求数据为:num1 = %d, num2 = %d",num1, num2);
-
- //逻辑处理
- if (num1 < 0 || num2 < 0)
- {
- ROS_ERROR("提交的数据异常:数据不可以为负数");
- return false;
- }
-
- //如果没有异常,那么相加并将结果赋值给 resp
- resp.sum = num1 + num2;
- return true;
-
-
- }
-
- ros::ServiceServer server = nh.advertiseService("AddInts",doReq);
- /**
- * \brief 生成服务端对象
- *
- * 该函数可以连接到 ROS master,并提供一个具有给定名称的服务对象。
- *
- * 使用示例如下:
- \verbatim
- bool callback(std_srvs::Empty& request, std_srvs::Empty& response)
- {
- return true;
- }
-
- ros::ServiceServer service = handle.advertiseService("my_service", callback);
- \endverbatim
- *
- * \param service 服务的主题名称
- * \param srv_func 接收到请求时,需要处理请求的回调函数
- * \return 请求成功时返回服务对象,否则返回空对象:
- \verbatim
- bool Foo::callback(std_srvs::Empty& request, std_srvs::Empty& response)
- {
- return true;
- }
- ros::NodeHandle nodeHandle;
- Foo foo_object;
- ros::ServiceServer service = nodeHandle.advertiseService("my_service", callback);
- if (service) // Enter if advertised service is valid
- {
- ...
- }
- \endverbatim
-
- */
- template<class MReq, class MRes>
- ServiceServer advertiseService(const std::string& service, bool(*srv_func)(MReq&, MRes&))
-------------------------------------------
三。 回旋函数
在ROS程序中,频繁的使用了 ros::spin() 和 ros::spinOnce() 两个回旋函数,可以用于处理回调函数
:ros::spin() 是进入了循环执行回调函数,而 ros::spinOnce() 只会执行一次回调函数(没有循环),在 ros::spin() 后的语句不会执行到,而 ros::spinOnce() 后的语句可以执行
所以在发布方中,我们使用的回旋函数也只是使用一次,
但是在订阅者中,需要不断回旋,所以我们使用spin
--------------------
四。 时间函数
(前面的历程我们并没有使用到,所以这里重新开始说明)
1. 时刻
- ros::init(argc,argv,"hello_time");
- ros::NodeHandle nh;//必须创建句柄,否则时间没有初始化,导致后续API调用失败
- ros::Time right_now = ros::Time::now();//将当前时刻封装成对象
- ROS_INFO("当前时刻:%.2f",right_now.toSec());//获取距离 1970年01月01日 00:00:00 的秒数
- ROS_INFO("当前时刻:%d",right_now.sec);//获取距离 1970年01月01日 00:00:00 的秒数
-
- ros::Time someTime(100,100000000);// 参数1:秒数 参数2:纳秒
- ROS_INFO("时刻:%.2f",someTime.toSec()); //100.10
- ros::Time someTime2(100.3);//直接传入 double 类型的秒数
- ROS_INFO("时刻:%.2f",someTime2.toSec()); //100.30
2。 持续时间
- ROS_INFO("当前时刻:%.2f",ros::Time::now().toSec());
- ros::Duration du(10);//持续10秒钟,参数是double类型的,以秒为单位
- du.sleep();//按照指定的持续时间休眠
- ROS_INFO("持续时间:%.2f",du.toSec());//将持续时间换算成秒
- ROS_INFO("当前时刻:%.2f",ros::Time::now().toSec());
3. 设置运行频率(这个是有出现过的,可以决定每一秒发送几次消息)
- ros::Rate rate(1);//指定频率
- while (true)
- {
- ROS_INFO("-----------code----------");
- rate.sleep();//休眠,休眠时间 = 1 / 频率。
- }
-------------------------
五。 其他函数
1. 循环的判断条件一般由节点状态来控制,C++中可以通过 ros::ok() 来判断节点状态是否正常
-
- while(ros::ok())
2. 日志函数 ---- printf 打印
- ROS_DEBUG("hello,DEBUG"); //不会输出
- ROS_INFO("hello,INFO"); //默认白色字体
- ROS_WARN("Hello,WARN"); //默认黄色字体
- ROS_ERROR("hello,ERROR");//默认红色字体
- ROS_FATAL("hello,FATAL");//默认红色字体