ros2中创建工程,访问serial串口

1、创建一个ros2工程包

ros2 pkg create --build-type ament_cmake ros2_demo --dependencies rclcpp std_msgs

2、在工程ros2_demo中创建include文件夹,在该文件内创建serial_test.h头文件

#include <serial/serial.h>
#include "rclcpp/rclcpp.hpp"

// originbot protocol data format
typedef struct {
    uint8_t header;
    uint8_t id;
    uint8_t length;
    uint8_t data[6];
    uint8_t check;
    uint8_t tail;
} DataFrame;


class SerialTest: public rclcpp::Node
{
private:
    serial::Serial serial_;
public:
    SerialTest(std::string nodeName);
    ~SerialTest();
    bool buzzer_control(bool on);
};

3、在工程包中的src目录下创建serial_test.cpp文件(node节点)

#include "ros2_demo/serial_test.h"


SerialTest::SerialTest(std::string nodeName):Node(nodeName)
{   
    std::string port_name="ttyUSB0";    
     // 控制器与扩展驱动板卡的串口配置与通信
    try
    {
        serial_.setPort("/dev/" + port_name);                            //选择要开启的串口号
        serial_.setBaudrate(115200);                                     //设置波特率
        serial::Timeout timeOut = serial::Timeout::simpleTimeout(2000);  //超时等待
        serial_.setTimeout(timeOut);                                     
        serial_.open();                                                  //开启串口
    }
    catch (serial::IOException &e)
    {
        RCLCPP_ERROR(this->get_logger(), "originbot can not open serial port,Please check the serial port cable! "); //如果开启串口失败,打印错误信息
    }
    // 初始化完成,蜂鸣器响5s,并输出日志
    buzzer_control(true);
    sleep(5);
    buzzer_control(false);

    RCLCPP_INFO(this->get_logger(), "OriginBot Start, enjoy it.");
}
SerialTest::~SerialTest()
{
    serial_.close();                                                  //关闭串口
}

bool SerialTest::buzzer_control(bool on)
{   

    RCLCPP_INFO(this->get_logger(), "in buzzer_control methos,buzzer is on");
    DataFrame configFrame;

    // 封装蜂鸣器指令的数据帧
    configFrame.header = 0x55;
    configFrame.id     = 0x07;
    configFrame.length = 0x06;
    configFrame.data[0]= 0x00;
    configFrame.data[1]= 0x00;
    configFrame.data[2]= 0xFF;

    if(on)
        configFrame.data[3]= 0xFF;
    else
        configFrame.data[3]= 0x00;

    configFrame.data[4]= 0x00;
    configFrame.data[5]= 0x00;
    configFrame.check = (configFrame.data[0] + configFrame.data[1] + configFrame.data[2] + 
                         configFrame.data[3] + configFrame.data[4] + configFrame.data[5]) & 0xff;
    configFrame.tail   = 0xbb; 

    try
    {
        serial_.write(&configFrame.header, sizeof(configFrame)); //向串口发数据
    }  

    catch (serial::IOException &e)
    {
        RCLCPP_ERROR(this->get_logger(), "Unable to send data through serial port"); //如果发送数据失败,打印错误信息
    }

    return true;
}

int main(int argc, char const *argv[])
{
    /* code */
    rclcpp::init(argc, argv);
    rclcpp::spin(std::make_shared<SerialTest>("first_test_serial"));
    rclcpp::shutdown();
    return 0;
}

4、修改CMakeLists.txt,添加serial依赖。完整的CMakeLists.txt文件如下

cmake_minimum_required(VERSION 3.8)
project(ros2_demo)

# Default to C99
if(NOT CMAKE_C_STANDARD)
  set(CMAKE_C_STANDARD 99)
endif()

# Default to C++14
if(NOT CMAKE_CXX_STANDARD)
  set(CMAKE_CXX_STANDARD 14)
endif()

if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
  add_compile_options(-Wall -Wextra -Wpedantic)
endif()

# find dependencies
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)
find_package(serial REQUIRED)

include_directories(
  include
  )


add_executable(serialtest src/serial_test.cpp)
target_link_libraries(serialtest serial)
ament_target_dependencies(serialtest rclcpp std_msgs serial)

#DIRECTORY:将指定目录中的文件和子目录复制到安装目录。
install(DIRECTORY include/ 
  DESTINATION include )

install(DIRECTORY launch
  DESTINATION share/${PROJECT_NAME} 
)

#TARGETS:安装指定的目标(可执行文件、库文件等)
install(TARGETS serialtest 
  DESTINATION lib/${PROJECT_NAME}) 

if(BUILD_TESTING)
  find_package(ament_lint_auto REQUIRED)
  # the following line skips the linter which checks for copyrights
  # comment the line when a copyright and license is added to all source files
  set(ament_cmake_copyright_FOUND TRUE)
  # the following line skips cpplint (only works in a git repo)
  # comment the line when this package is in a git repo and when
  # a copyright and license is added to all source files
  set(ament_cmake_cpplint_FOUND TRUE)
  ament_lint_auto_find_test_dependencies()
endif()

ament_export_include_directories(include)
ament_package()

5、编译ros源码

colcon build --packages-select ros2_demo
source install/setup.bash   

6、运行

ros2 run ros2_demo serialtest

注意:直接运行该serialtest可执行文件,会报找不到libserial.so动态库。需要把build目录下的serialtest可执行文件复制到install/ros2_demo/lib/ros2_demo/目录下的替换该可执行文件。(因为发现build目录下的可执行文件可以正常链接到动态库。而intall下可执行文件没能正常链接,暂时不知道什么原因,待解决。)

  • 3
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
提供的源码资源涵盖了安卓应用、小程序、Python应用和Java应用等多个领域,每个领域都包含了丰富的实例和项目。这些源码都是基于各自平台的最新技术和标准编写,确保了在对应环境下能够无缝运行。同时,源码配备了详细的注释和文档,帮助用户快速理解代码结构和实现逻辑。 适用人群: 这些源码资源特别适合大学生群体。无论你是计算机相关专业的学生,还是对其他领域编程感兴趣的学生,这些资源都能为你提供宝贵的学习和实践机会。通过学习和运行这些源码,你可以掌握各平台开发的基础知识,提升编程能力和项目实战经验。 使用场景及目标: 在学习阶段,你可以利用这些源码资源进行课程实践、课外项目或毕业设计。通过分析和运行源码,你将深入了解各平台开发的技术细节和最佳实践,逐步培养起自己的项目开发和问题解决能力。此外,在求职或创业过程,具备跨平台开发能力的大学生将更具竞争力。 其他说明: 为了确保源码资源的可运行性和易用性,特别注意了以下几点:首先,每份源码都提供了详细的运行环境和依赖说明,确保用户能够轻松搭建起开发环境;其次,源码的注释和文档都非常完善,方便用户快速上手和理解代码;最后,我会定期更新这些源码资源,以适应各平台技术的最新发展和市场需求。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

恋上钢琴的虫

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值