Ejemplo n.º 1
0
 def ping(self,sink,dst):
     """Send ping to slave ping <host>"""
     bus = Bus(self.interface.ser)
     self.sendline(sink,"Sending ping to %s" % dst)
     bus.send_ping(int(dst))
Ejemplo n.º 2
0
    def run(self):
        self.running = True
        packet = Packet() #Start packet class
        bus = Bus(self.ser) #Start bus class
        while self.running:
            if self.ser.inWaiting() == 0:
                time.sleep(0.1) 
                continue
            #Receive data from application master
            buffert = 0
            try:
                packet.src = [ord(bus.read(1)),ord(bus.read(1))]    #recieve source address
                packet.dst = [ord(bus.read(1)),ord(bus.read(1))]    #recieve destination address
                packet.id = ord(bus.read(1))                        #recieve packet id
                packet.len = ord(bus.read(1))                       #recieve packet len
            except:
                #if some of above fails start all over
                packet = object
                packet = Packet()
                self.ser.flushInput()
                continue

            #Start recieving packet data
            if packet.len > 32:
                packet.type = packet.len
                packet.len = 0
            else:
                while (buffert != packet.len):
                    buffert=buffert+1
                    packet.data.append(bus.read(1)) # add the recieved data to the packet

            packet.checksum = []
            packet.checksum.append(ord(bus.read(1)))
            packet.checksum.append(ord(bus.read(1))) #read checksum from the bus

            #Check if the checksum is ok
            if packet.check_checksum() != 1: 
                print "Packet Checksum: invalid"
                #Stop processing packet and restart 
                packet = object
                packet = Packet()
                continue

            if self.options.debug:
                print "Checksum: input: %s %s Output: %s %s" % (packet.checksum[0],packet.checksum[1],packet.checksum_data[0],packet.checksum_data[1])
                print "Packet data: %s" % ''.join(packet.data)
                print "Packet len: %s" % packet.len
                print "Packet Type: %s" % packet.type
                print "Packet ID: %s" % (packet.id)
                print "Packet src_net: %s" % packet.src[0]
                print "Packet src_host: %s" % packet.src[1]
                print "Packet dst_net: %s" % packet.dst[0]
                print "Packet dst_host: %s" % packet.dst[1]
                print "Buffer size: %s" % self.ser.inWaiting()

            time.sleep(0.5)

            bus = Bus(self.ser) #Create a bus for returning data
            if packet.type == 253:
                self.ser.flushInput()
                time.sleep(2)
                bus.send_welcome(packet)
                time.sleep(2)
                bus.send_ping(5)
            if packet.type == 254:
                print "\r\nReceived PONG from: %s" % packet.src[1]