''''''
Created on May 26, 2011

@author: Aaron Curtis
'''

import android
from base64 import b64decode, b64encode

distoMacAddr='10:00:E8:C0:F2:D8'

def connectToDstx(distoMacAddr=distoMacAddr):
    """
    Connect to the DistoX at distoMacAddr and return an android object.
    """
    dr=android.Android()
    dr.bluetoothStop()
    dr.bluetoothConnect('00001101-0000-1000-8000-00805F9B34FB','10:00:E8:C0:F2:D8')
    return dr

def getAleg(dr):
    """
    Download one leg from the DistoX connected to android instance dr
    and return it as a string of hex characters. Also sends acknowledge
    byte to DistoX.
    """
    dstxPacket=b64decode(dr.bluetoothReadBinary(8).result)
    firstByte=ord(dstxPacket[0])
    print dstxPacket
    #Send acknowledgement.
    if firstByte==0b00000001:
        dr.bluetoothWriteBinary(b64encode(chr(0b01010101)))
    elif firstByte==0b10000001:
        dr.bluetoothWriteBinary(b64encode(chr(0b11010101)))
    return dstxPacket
          

def getAllLegs(dr):
    """
    Take download all survey legs from the DistoX connected to android
    instance dr, and return them as a list.
    """ 
    legs=[None]
    while legs[-1]!='':
        #get a leg
        legs.append(processLeg(getAleg(dr)))
        print legs[-1]
        dr.makeToast(str(legs[-1]))
    #Trim off the None that we used to avoid an IndexError
    legs=legs[1:]
    return legs

def processLeg(leg):
    """
    Given a DistoX leg as a string of hex characters, returns
    a dictionary of the data.
    """
    distance=ord(leg[1])+(ord(leg[2])<<8)+(ord(leg[0])&7)
    compass=((ord(leg[3])+(ord(leg[4])<<8))*360.0/2**16)
    clino=((ord(leg[5])+(ord(leg[6])<<8))*360.0/2**16)
    outp={'distance':distance, 'compass':compass, 'clino':clino}
    return outp
    
    
dr=connectToDstx()
outp=getAllLegs(dr)