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))
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]
