from intelhex import IntelHex;
import Queue
import math
+import wave
tT = time
class FordExperiments(experiments):
is a simple "background" retriever in that it returns the packet
that is of the given id that was sniffed off the bus.
"""
+ self.client.serInit()
+ self.spitSetup(500)
+ self.addFilter([sId,sId,sId,sId,sId,sId])
packet1 = self.client.rxpacket();
if(packet1 != None):
packetParsed = self.client.packet2parsed(packet1);
#keep sniffing till we read a packet
startTime = time.time()
- while( packet1 == None or packetParsed.get('sID') != sId and (time.time() - startTime) < 20):
+ while( (packet1 == None or packetParsed.get('sID') != sId) and (time.time() - startTime) < 5):
packet1 = self.client.rxpacket()
+ print packet1
if(packet1 != None):
packetParsed = self.client.packet2parsed(packet1)
-
+ if( packet1 == None or packetParsed.get('sID') != sId):
+ print "exiting without packet"
+ #print "returning", packetParsed
#recieveTime = time.time()
return packetParsed
packet = self.getBackground(1056)
SIDlow = (1056 & 0x07) << 5; # get SID bits 2:0, rotate them to bits 7:5
SIDhigh = (1056 >> 3) & 0xFF; # get SID bits 10:3, rotate them to bits 7:0
- odomFuzz = random.randint(0,255)
+ odomFuzz = random.randint(1,254)
print packet
newPacket = [SIDhigh, SIDlow, 0x00,0x00, # pad out EID regs
0x08, # bit 6 must be set to 0 for data frame (1 for RTR)
startTime = time.time()
packet[6] = odomFuzz;
while( time.time()- startTime < 10):
- odomFuzz = random.randint(0,255)
+ odomFuzz = random.randint(1,254)
newPacket[6] = odomFuzz
self.client.txpacket(newPacket)
self.multiPacketSpit(packet0rts=True)
- def warningLightsOn(self,checkEngine, checkTransmission, transmissionOverheated, engineLight, battery, fuelCap, checkBreakSystem,ABSLight):
- self.addFilter([1056, 1056, 530, 530, 1056])
+ def warningLightsOn(self,checkEngine, checkTransmission, transmissionOverheated, engineLight, battery, fuelCap, checkBreakSystem,ABSLight, dashB):
+
if( checkBreakSystem == 1 or ABSLight == 1):
SIDlow = (530 & 0x07) << 5; # get SID bits 2:0, rotate them to bits 7:5
SIDhigh = (530 >> 3) & 0xFF; # get SID bits 10:3, rotate them to bits 7:0
+ print "looking for 530"
packet = self.getBackground(530)
+ print "found"
packet2 = [SIDhigh, SIDlow, 0x00,0x00, # pad out EID regs
0x08, # bit 6 must be set to 0 for data frame (1 for RTR)
# lower nibble is DLC
- ord(packet[5]),ord(packet[6]),ord(packet[7]),ord(packet[8]),ord(packet[9]),ord(packet[10]),ord(packet[11]),ord(packet[12])]
+ packet['db0'],packet['db1'],packet['db2'],packet['db3'],packet['db4'],packet['db5'],packet['db6'],packet['db7']]
if( checkBreakSystem == 1 and ABSLight == 1):
packet2[9] = 97
elif( checkBreakSystem == 0 and ABSLight == 1):
print packet2
SIDlow = (1056 & 0x07) << 5; # get SID bits 2:0, rotate them to bits 7:5
SIDhigh = (1056 >> 3) & 0xFF; # get SID bits 10:3, rotate them to bits 7:0
+ print "looking for 1056"
packet = self.getBackground(1056)
+ print "found"
packet1 = [SIDhigh, SIDlow, 0x00,0x00, # pad out EID regs
0x08, # bit 6 must be set to 0 for data frame (1 for RTR)
# lower nibble is DLC
- ord(packet[5]),ord(packet[6]),ord(packet[7]),ord(packet[8]),ord(packet[9]),ord(packet[10]),ord(packet[11]),ord(packet[12])]
+ packet['db0'],packet['db1'],packet['db2'],packet['db3'],packet['db4'],packet['db5'],packet['db6'],packet['db7']]
if( checkEngine == 1):
packet1[9] += 2;
print packet1
if( fuelCap == 1):
packet1[10] = 255
print packet1
- if( batter == 1):
- packet1[6] = 33
+ if( battery == 1):
+ packet1[7] = 33
print packet1
+ if( dashB == 1):
+ packet1[6] = 255
+ print "hello"
+ self.client.serInit()
+ self.spitSetup(500)
# load new packet into TXB0 and check time
self.multiPacketSpit(packet0=packet1,packet1=packet2, packet0rts=True,packet1rts=packet2rts )
starttime = time.time()
-
+ print "starting"
# spit new value for 1 second
while ((time.time()-starttime) < 10):
self.multiPacketSpit(packet0rts=True,packet1rts = packet2rts)
# NOW THE FUN STUFF!!!!!
- music = wave.open("../../contrib/ted/beethovensfifth.wav", 'r');
+ music = wave.open("../../contrib/ted/beethovensfifth.wav.wav", 'r');
print "number of frames: %d " %music.getnframes()
print "number of channels: %d " %music.getnchannels()
print "sample width: %d " %music.getsampwidth()
print "framerate: %d " %music.getframerate()
print "compression: %s " %music.getcompname()
- length = music.getnframes()
- pos = music.tell()
- print " NOW NOW NOW NOW NOW NOW NOW NOW NOW"
- while(pos < music.getnframes()):
- runningaverage = 0
+ numFramesToRead = music.getframerate()*.1 # grab .1s of audio
+
+ while(1):
+
+ runningSum = 0
- pos = music.tell()
- sample = music.readframes(8820) #approximately .2 seconds of audio --> 7133184/44100/.1
- #print "NEXT FRAME"
+ sample = music.readframes(numFramesToRead) # grab .1s of audio
length = len(sample)
- #print length
for i in range(0, length,4):
- runningaverage += max(ord(sample[i]), ord(sample[i+2]))#ord(sample[i])
-
- avg = runningaverage/(length / 4)
- #print avg
+ runningSum += ord(sample[i]) #average the dual-channel
+ runningSum += ord(sample[i+2])
-
- #print avg-165
- val = (40 + 3*(avg-165))
+ avg = runningSum/(length / 2) # we used 2 of every 4 frames, so divide length by 2
+
+ val = (40 + 5*(avg-120)) # normalize to speedometer range of values
print "speedometerVal = %f " %val;
- print "speed = %f" %(1.617*val-63.5)
+ print "speed = %f" %(1.617*val-63.5) # speed we're trying to display
- if (val > 255):
+ if (val > 255): # ensure we don't run off acceptable range
val = 255
elif (val < 0):
val = 0
- newPacket[9] = int(val)
+ newPacket[9] = int(val) # write it to the packet
# load new packet into TXB0 and check time
self.multiPacketSpit(packet0=newPacket, packet0rts=True)
starttime = time.time()
# spit new value for 1 second
- while (time.time()-starttime < .2):
+ while (time.time()-starttime < .1):
self.multiPacketSpit(packet0rts=True)
-#for foo in byte:
-# print "%d" %ord(foo)
-
-#39.27
-#113
-