import bluetooth
import serial
import time
import select
import Queue
import binascii

ser = serial.Serial('/dev/ttyACM0',115200, timeout = 1)#parity = serial.PARITY_EVEN,
#time.sleep(2)

if ser.isOpen():
    print ("ACM0 Port open")

print ("Waiting for Bluetooth connection")
server_sock=bluetooth.BluetoothSocket(bluetooth.RFCOMM)
port = 1
server_sock.bind(("",port))
server_sock.listen(1)
print("Listening on port",port)
client_sock,address = server_sock.accept()
print ("Accepted connection from ",address)

while 1:

    print "Waiting for data"
    try:

        recvdata = client_sock.recv(10)
        if (recvdata == "9"):
                print ("Exiting...")
                break
        else:
                print ("Received \"%s\" through Bluetooth" % recvdata)
                #test = 0x35
                #print (recvdata == test)
                ser.write(bytearray(recvdata))#.encode('hex')) #sending data to ACM0
                print ("Sent \"%s\" to ACM0" % recvdata)

                #time.sleep(0.1)
                print ("ACM0 response:")
                x = ser.read(ser.inWaiting()).encode('hex') #read form acm0

                #time.sleep(0.3)
                print ("Read before conversion ", x)
                ##
                ## string x --> wyslal jako byte / hex
                ##
                print type(x)
                new = bytearray.fromhex(x)
                print type(new)
                new = str(new)
                print type(new)
                print ("After conversion " , new )
                client_sock.send(new) #send data back to computer
                del recvdata
                x= ""
                new = ""

    except:
        print "Error"
        time.sleep(0.1)

client_sock.close()
server_sock.close()
ser.close()