ROS-wifi及以太网通信

硬件环境：M4传感采集板，Firefly控制板、笔记本电脑、Wifi
编程语言：Python

通信过程：

M4采集传感器信号，传感器信号通过M4的以太网接口通过网线传输至Firefly控制板，控制板接受M4的传感器信号后，对信号进行解码，发送返回信号回M4，并将数据发布在ROS指定话题上，同wifi局域网下的笔记本电脑LT-0079通过订阅话题信息获得传感器数据。

操作步骤：

1.通信环境配置：

1.1 Firefly端(主控板):

1.1.1设置Firefly的wifi网络IP地址

    IPV4 Settings：Manual
    Address：192.168.20.133  
    Netmask：255.255.255.0
    Gateway：192.168.20.1

1.1.2 设置Firefly的host

sudo vim /etc/hosts

    192.168.20.133  firefly     # (本机ip)，中间tab隔开
    192.168.20.135  LT-0079         #(服务器IP)

1.1.3 设置firefly的ros环境（以LT-0079为主机）

vim ~/bashrc -->添加

    export ROS_HOSTNAME=firefly
    export ROS_MASTER_URI=http://LT-0079:11311

1.2 PC端：

1.2.1设置LT-0079的wifi网络IP地址

    IPV4 Settings：Manual
    Address：192.168.20.135 
    Netmask：255.255.255.0
    Gateway：192.168.20.1

1.2.2 设置LT-0079的host

sudo vim /etc/hosts

    192.168.20.133  firefly 
    192.168.20.135  LT-0079 

1.2.3 设置LT-0079的ros环境（以LT-0079为主机）

vim ~/bashrc -->添加

    export ROS_HOSTNAME=LT-0079
    export ROS_MASTER_URI=http://LT-0079:11311

2.firefly上编写与M4网口通信程序

2.1.新建workspace

mkdir -p ~/ros_newlife/src
catkin_init_worksapce

2.2.创建package

catkin_creat_pkg M4_Ros rospy roscpp message_generation

2.3更改package.xml文件与CMakeList.txt

vim ~/workspace/src/package_name/package.xml

message_generation
message_runtime

vim ~/workspace/src/package_name/CMakelist

find_package(catkin REQUIRED COMPONENTS roscpp rospy  std_msgs message_generation)
generate_messages(  DEPENDENCIES  std_msgs)
add_message_files(  FILES  M4_Sensor.msg)

2.4 新建msg文件

mkdir msg
vim msg/M4_Sensor.msg

int32 Start
int32 Start
int12 Count
int12 Red_Dis1
int12 Red_Dis2
int12 Red_Dis3
int12 Red_Dis4
int12 Ult_Dis1
int12 Ult_Dis2
int12 Ult_Dis3
int12 Ult_Dis4
int12 Red_Hum1
int12 Red_Hum2
int12 Red_Hum3
int12 Red_Hum4
int12 Voice1
int12 Voice2
int12 Voice3
int12 Voice4
int12 Voice5
int12 Voice6
int12 Fsr_Head
int12 Fsr_Lwing
int12 Fsr_Rwing
int12 Fsr_Front
int12 Fsr_Back
int12 Check

2.5 编写主程序

vim src/M4Sensor_Publisher.py

#!/usr/bin/python
# -*- coding: utf-8 -*-

#Author: zhouwei
#Date: 20160307

import time
import socket
import rospy
from M4_Ros.msg import M4_Sensor
import json


######################tcp socket addr setting
HOST='192.168.2.4'
PORT=8008
BUFFER=4096
#####################tcp socket start
        sock=socket.socket(socket.AF_INET,socket.SOCK_STREAM)
sock.bind((HOST,PORT))
sock.listen(5)
print 'i am listening'
con,addr=sock.accept()

################ros begining
rospy.init_node('M4Sensor_Pub',anonymous=0)
pub=rospy.Publisher('M4Sensor',M4_Sensor,queue_size=10)

while not rospy.is_shutdown():
    try:
        con.settimeout(5)
        buf=con.recv(BUFFER)
        if len(buf) != 0:
        Sensor=M4_Sensor()
            buf_array=json.loads(buf)
            Sensor.Start=buf_array[0]
            Sensor.Count=buf_array[1]
            Sensor.Red_Dis1=buf_array[2]
            Sensor.Red_Dis2=buf_array[3]
            Sensor.Red_Dis3=buf_array[4]
            Sensor.Red_Dis4=buf_array[5]
            Sensor.Ult_Dis1=buf_array[6]
            Sensor.Ult_Dis2=buf_array[7]
            Sensor.Ult_Dis3=buf_array[8]
            Sensor.Ult_Dis4=buf_array[9]
            Sensor.Red_Hum1=buf_array[10]
            Sensor.Red_Hum2=buf_array[11]
            Sensor.Red_Hum3=buf_array[12]
            Sensor.Red_Hum4=buf_array[13]
            Sensor.Voice1=buf_array[14]
            Sensor.Voice2=buf_array[15]
            Sensor.Voice3=buf_array[16]
            Sensor.Voice4=buf_array[17]
            Sensor.Voice5=buf_array[18]
            Sensor.Voice6=buf_array[19]
            Sensor.Fsr_Head=buf_array[20]
            Sensor.Fsr_Lwing=buf_array[21]
            Sensor.Fsr_Rwing=buf_array[22]
            Sensor.Fsr_Front=buf_array[23]
            Sensor.Fsr_Back=buf_array[24]
            Sensor.Check=buf_array[25]
            rospy.loginfo('Data is %s'% Sensor)
            pub.publish(Sensor)
            con.send('yes')
        else:
            print('no data')
            con.send('out of client')
            con.close()
            con,addr=sock.accept()
    except socket.timeout:
        print 'time out'

2.6 make文件

chmod +x ~/ros_newlife/src/M4_Ros/src/M4Sensor_Publisher.py

cd ~/ros_newlife | catkin_make

3. LT-0079上编写服务器接受程序

3.1.新建workspace

mkdir -p ~/ros_newlife/src

catkin_init_worksapce

3.2.创建package

catkin_creat_pkg V6demo rospy roscpp message_generation

3.3更改package.xml文件与CMakeList.txt

vim ~/ros_newlife/src/V6demo/package.xml

message_generation
message_runtime

vim ~/ ros_newlife/src/V6demo/CMakelist

find_package(catkin REQUIRED COMPONENTS roscpp rospy  std_msgs message_generation)
generate_messages(  DEPENDENCIES  std_msgs)
add_message_files(  FILES  M4_Sensor.msg)

3.4 新建msg文件

mkdir msg
vim msg/M4_Sensor.msg

"与firefly端一致"

3.5 编写主程序

vim src/M4Sensor_Subscriber.py

#!/usr/bin/python
# -*- coding: utf-8 -*-

import rospy
from V6demo.msg import M4_Sensor

def callback(data):
    rospy.loginfo('i recv \n')
    rospy.loginfo(data)
    #rospy.loginfo(data.Ult_Dis1)


rospy.init_node('M4Sensor_Sub',anonymous=0)
rospy.Subscriber('M4Sensor',M4_Sensor,callback)
rospy.spin()

3.6 make文件

chmod +x ~/ros_newlife/src/V6demo/src/M4Sensor_Subscriber.py

cd ~/ros_newlife | catkin_make

4. 程序运行

LT-0079:(远程笔记本)

Terminal 1:

rosocre

Terminal 2:

cd ~/joey_newlife
source devel/setup.bash
rosrun V6demo M4Sensor_Subscriber.py

Firefly:(本地主控板)

Terminal 1:

cd ~/joey_newlife
source devel/setup.bash
rosrun V6demo M4Sensor_Publisher.py

M4:(传感采集板)

运行程序....