Python CAN 예제들

예제 #1

파일: nhk2015_back.py 프로젝트: herjunodimas/nhk2015_back_ros

def mb1swing(msg):
    if mode !=2:
        send = CAN()
        send.stdId = 0x122
        send.extId = -1
        send.data = struct.pack('f', msg.data)
        pub.publish( send )

예제 #2

파일: nhk2015_back.py 프로젝트: ukaana99/nhk2015_back_ros

def autoSwingCallback(msg):
    if mode == 2:
        send = CAN()
        send.stdId = 0x122
        send.extId = -1
        send.data = struct.pack('f', msg.data)
        pub.publish(send)

예제 #3

파일: nhk2015_back.py 프로젝트: herjunodimas/nhk2015_back_ros

def autoSwingCallback(msg):
    if mode ==2:
        send = CAN()
        send.stdId = 0x122
        send.extId = -1
        send.data = struct.pack('f', msg.data)
        pub.publish( send )

예제 #4

파일: nhk2015_back.py 프로젝트: ukaana99/nhk2015_back_ros

def mb1swing(msg):
    if mode != 2:
        send = CAN()
        send.stdId = 0x122
        send.extId = -1
        send.data = struct.pack('f', msg.data)
        pub.publish(send)

예제 #5

파일: nhk2015_back.py 프로젝트: herjunodimas/nhk2015_back_ros

def handCallback(msg):
    send = CAN()
    send.stdId = 0x150
    send.extId = -1
    if msg.data:
        send.data = [0xff]
    else:
        send.data = [0x00]
    pub.publish( send )

예제 #6

파일: nhk2015_third.py 프로젝트: herjunodimas/nhk2015_back_ros

def mb1swing(msg):
    if mode !=2:
        send = CAN()
    	send.stdId = 0x150
    	send.extId = -1
    	if msg.data:
        	send.data = [0xff]
    	else:
        	send.data = [0x00]
        pub.publish( send )

예제 #7

파일: test.py 프로젝트: ukaana99/nhk2015_back_ros

def talker():
    pub = rospy.Publisher('cantx', CAN, queue_size=100)
    rospy.init_node('canusb_test', anonymous=True)
    r = rospy.Rate(10)  # 10Hz
    count = 0
    while not rospy.is_shutdown():
        msg = CAN()
        msg.stdId = 1
        msg.extId = -1
        msg.data = struct.pack('B', count % 256) + 'ABCDE'
        pub.publish(msg)

        msg = CAN()
        msg.stdId = 100
        msg.extId = 25
        msg.data = struct.pack('i', count)
        pub.publish(msg)

        count += 1

        r.sleep()

예제 #8

파일: canusb_node.py 프로젝트: ukaana99/nhk2015_back_ros

 def analyze(self, str):
     command = str[:1]
     if command == 't':
         self.msg = CAN()
         self.dlc = int(str[4:5],16)
         self.msg.timestamp = rospy.get_rostime()
         self.msg.stdId = int(str[1:4],16)
         self.msg.extId = -1
         for i in range(0, self.dlc):
             self.msg.data +=  struct.pack('B', int(str[5+i*2:7+i*2],16))
         return self.msg
     elif command == 'T':
         self.msg = CAN()
         self.dlc = int(str[9:10],16)
         self.msg.timestamp = rospy.get_rostime()
         self.msg.stdId = int(str[1:9],16)%0x400
         self.msg.extId = int(str[1:9],16)/0x400
         for i in range(0, self.dlc):
             self.msg.data +=  struct.pack('B', int(str[10+i*2:12+i*2],16))
         return self.msg
     else:
         return 0

예제 #9

파일: nhk2015_back.py 프로젝트: ukaana99/nhk2015_back_ros

def handCallback(msg):
    send = CAN()
    send.stdId = 0x150
    send.extId = -1
    if msg.data:
        send.data = [0xff]
    else:
        send.data = [0x00]
    pub.publish(send)

예제 #10

파일: nhk2015_third.py 프로젝트: ukaana99/nhk2015_back_ros

def autoSwingCallback(msg):
    if mode == 2:
        send = CAN()
        send.stdId = 0x150
        send.extId = -1
        if msg.data:
            if isright == True:
                send.data = [0xfb]
            else:
                send.data = [0xfe]
        else:
            send.data = [0x00]
        pub.publish(send)

예제 #11

파일: nhk2015_third.py 프로젝트: ukaana99/nhk2015_back_ros

def mb1swing(msg):
    if mode != 2:
        send = CAN()
        send.stdId = 0x150
        send.extId = -1
        if msg.data:
            send.data = [0xff]
        else:
            send.data = [0x00]
        pub.publish(send)

예제 #12

파일: nhk2015_third.py 프로젝트: herjunodimas/nhk2015_back_ros

def autoSwingCallback(msg):
    if mode ==2:
        send = CAN()
    	send.stdId = 0x150
    	send.extId = -1
    	if msg.data:
            if isright == True:
                send.data = [0xfb]
            else:
                send.data = [0xfe]
    	else:
        	send.data = [0x00]
        pub.publish( send )

예제 #13

파일: nhk2015_third.py 프로젝트: ukaana99/nhk2015_back_ros

def mb1motor2(msg):
    send = CAN()
    send.stdId = 0x121
    send.extId = -1
    send.data = struct.pack('f', msg.data)
    pub.publish(send)

예제 #14

파일: nhk2015_third.py 프로젝트: ukaana99/nhk2015_back_ros

def omni3(msg):
    send = CAN()
    send.stdId = 0x112
    send.extId = -1
    send.data = struct.pack('f', msg.data)
    pub.publish(send)

예제 #15

파일: nhk2015_back.py 프로젝트: herjunodimas/nhk2015_back_ros

def mb1motor2(msg):
    send = CAN()
    send.stdId = 0x121
    send.extId = -1
    send.data = struct.pack('f', msg.data)
    pub.publish( send )

예제 #16

파일: nhk2015_back.py 프로젝트: herjunodimas/nhk2015_back_ros

def omni3(msg):
    send = CAN()
    send.stdId = 0x112
    send.extId = -1
    send.data = struct.pack('f', msg.data)
    pub.publish( send )