1.1 Ubuntu18.04 ROS tcp/ip Server通信实现

Ubuntu18.04 ROS tcp/ip Server通信实现

此小节介绍tcp/ip Server收发数据,并将截取到底信息通过话题方式发布出去。下一节介绍Ubuntu18.04 ROS tcp/ip client通信实现。 后续介绍Android与Ubuntu的网络通信,通过Android与工控机配合实现车辆遥控操作。

测试过程和效果

测试平台为Ubuntu18.04 与Windows系统上的网络调试助手进行通信测试,调试助手采用的有人科技的USR-TCP232-Test-V1.3。
测试过程为:
1.保证两台电脑在同一个网络下,并查看Ubuntu的本机IP,在设置->wifi->中可查看,如下图,192.168.x.xxx,为本机IP。
1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第1张图片

  1. 相互ping另外一台电脑的ip,通则说明两台电脑在同一网络下连接成功。windows打开网络串口助手可自动获取本机IP。如下图。如果ping失败请查看防护墙是否关闭。
    1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第2张图片
    ping成功的图片如下
    Windows
    1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第3张图片
    Ubuntu
    1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第4张图片
    3 通信效果测试,首先Ubuntu运行roscore,然后启动服务器节点,然后打开网络调试助手,输入服务器IP,通信成功的截图如下:
    1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第5张图片
    1.1 Ubuntu18.04 ROS tcp/ip Server通信实现_第6张图片

ROS工作区间和功能包的创建

ROS工作区间和功能包的创建网上资料比较多,这里简单说明。其中使用RoboWare Studio,这个过程变的更简单。

#创建工作空间
mkdir catkin_ws #区间名称
cd catkin_ws 
mkdir src #创建代码空间
cd src
catkin_init_workspace #初始化位ROS工作空间
cd ..
catkin_make
source ~/catkin_ws/devel/setup.bash
#创建功能包
cd ~/catkin_ws/src
catkin_create_pkg ros_socket std_msgs rospy roscpp
#创建通信节点
#在src目录下打开终端
touch server_node.cpp
#在CMakeLists.txt中添加以下
add_executable(server_node
  srcrver_node.cpp
)
add_dependencies(server_node ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
target_link_libraries(server_node
  ${catkin_LIBRARIES}
)

``

ROS tcp/ip Server的实现代码

包括以下步骤
1.创建一个socket
2.准备通讯地址(必须是服务器的)也就算是本机的IP
3.bind()绑定
4.监听客户端listen()函数
5.等待客户端的连接accept(),返回用于交互的socket描述符
程序注释的比较清楚,不在多说了。

#include
#include
#include
#include
#include
#include
#include
#include
#include 
#include "navgation_pack/androidyaokong.h"

using namespace std;

navgation_pack::androidyaokong wangluo;

int main(int argc, char** argv)
{
    ros::init(argc, argv, "server_port");
    //创建句柄(虽然后面没用到这个句柄,但如果不创建,运行时进程会出错)
    ros::NodeHandle n;

    ros::Publisher tcp_jie =n.advertise<navgation_pack::androidyaokong>("/android_para", 100);

    //1.创建一个socket
    int socket_fd = socket(AF_INET, SOCK_STREAM, 0);
    if (socket_fd == -1)
    {
        cout << "socket 创建失败: "<< endl;
        exit(1);
    }
    //2.准备通讯地址(必须是服务器的)192.168.181.22是本机的IP
    struct sockaddr_in addr;
    addr.sin_family = AF_INET;
    addr.sin_port = htons(1024);//将一个无符号短整型的主机数值转换为网络字节顺序,即大尾顺序(big-endian)
    addr.sin_addr.s_addr = inet_addr("192.168.1.113");//net_addr方法可以转化字符串,主要用来将一个十进制的数转化为二进制的数,用途多于ipv4的IP转化。
    //3.bind()绑定
    //参数一:0的返回值(socket_fd)
    //参数二:(struct sockaddr*)&addr 前面结构体,即地址
    //参数三: addr结构体的长度
    int res = bind(socket_fd,(struct sockaddr*)&addr,sizeof(addr));
    if (res == -1)
    {
        cout << "bind创建失败: " << endl;
        exit(-1);
    }
    cout << "bind ok 等待客户端的连接" << endl;
    //4.监听客户端listen()函数
    //参数二:进程上限,一般小于30
    listen(socket_fd,30);
    //5.等待客户端的连接accept(),返回用于交互的socket描述符
    struct sockaddr_in client;
    socklen_t len = sizeof(client);
    int fd = accept(socket_fd,(struct sockaddr*)&client,&len);
    if (fd == -1)
    {
        cout << "accept错误\n" << endl;
        exit(-1);
    }
    //6.使用第5步返回socket描述符,进行读写通信。
    char *ip = inet_ntoa(client.sin_addr);
    cout << "客户: 【" << ip << "】连接成功" << endl;
  
    write(fd, " Welcome to visit ", 17);
    char buffer[255]={};

    ros::Rate loop_rate(50);
   while (ros::ok()) 
   {
       int size = read(fd, buffer, sizeof(buffer));//通过fd与客户端联系在一起,返回接收到的字节数
    //第一个参数:accept 返回的文件描述符
    //第二个参数:存放读取的内容
    //第三个参数:内容的大小
        if (size>=1) //接受到数据进行处理
        {
        //   cout << "接收到字节数为: " << size << endl;
        //    cout << "内容: " << buffer << endl;
            string jieshou = buffer;
            string jieshou_chuli = jieshou.substr(0,3);

            string qia = "qia";
            string hou = "hou";
            string zuo = "zuo";
            string you = "you";
            string tin = "tin";

            //   cout << jieshou_chuli << endl;
             cout << jieshou << endl;
            if (strcmp(jieshou_chuli.c_str(),qia.c_str())==0)//判断接受到的字符串是否相同
            {
                string jieshou_p = jieshou.substr(7,1);//截取字符串
                int q = atoi(jieshou_p.c_str());
                wangluo.qianjin = q ;
                cout << jieshou_p<<"qian    "<< q << endl;
            }

            if (strcmp(jieshou_chuli.c_str(),hou.c_str())==0)
            {
                string jieshou_p = jieshou.substr(6,1);
                int q = atoi(jieshou_p.c_str());
                wangluo.houtui = q ;
                wangluo.qianjin = 0 ;
                cout << jieshou_p<<"hou    "<< q << endl;
            }

                if (strcmp(jieshou_chuli.c_str(),zuo.c_str())==0)
            {
                string jieshou_p = jieshou.substr(8,1);
                int q = atoi(jieshou_p.c_str());
                wangluo.zuozhuan = q ;
                wangluo.youzhang = 0;
                cout << jieshou_p<<" zuo   "<< q << endl;
            }

                if (strcmp(jieshou_chuli.c_str(),you.c_str())==0)
            {
                string jieshou_p = jieshou.substr(8,1);
                int q = atoi(jieshou_p.c_str());
                wangluo.youzhang = q ;
                wangluo.zuozhuan = 0;
                cout << jieshou_p<<"you    "<< q << endl;
            }

                if (strcmp(jieshou_chuli.c_str(),tin.c_str())==0)
            {
                string jieshou_p = jieshou.substr(7,1);
                int q = atoi(jieshou_p.c_str());
            //     wangluo.qianjin = 0 ;
                wangluo.houtui = 0 ;
                wangluo.zuozhuan = 0 ;                  
                wangluo.tingzhi = 0 ;
                wangluo.youzhang = 0 ;
                cout << jieshou_p<<"tin    "<< q << endl;
            }

                 tcp_jie.publish(wangluo);

        }
                ros::spinOnce(); 
                loop_rate.sleep(); 
     }
        
    //7.关闭sockfd
    close(fd);
    close(socket_fd);
    return 0;
}


功能包程序。

1.5 章节重新修改了一下服务器程序,删除了自定义消息类型,编译不报错。

欢迎大家批评指正!!!

你可能感兴趣的:(tcp/ip,自动驾驶,linux)