Raspberry Pi Forums

Code: Select all

# -*- coding: utf-8 -*
import serial
import time

ser = serial.Serial("/dev/ttyUSB0", 115200)

def getTFminiData():
    while True:
        time.sleep(0.1)
        count = ser.in_waiting
        if count > 8:
            recv = ser.read(9)  
            ser.reset_input_buffer()  
            # type(recv), 'str' in python2(recv[0] = 'Y'), 'bytes' in python3(recv[0] = 89)
            # type(recv[0]), 'str' in python2, 'int' in python3 
            
            if recv[0] == 0x59 and recv[1] == 0x59:     #python3
                distance = recv[2] + recv[3] * 256
                strength = recv[4] + recv[5] * 256
                print('(', distance, ',', strength, ')')
                ser.reset_input_buffer()
                
            #if recv[0] == 'Y' and recv[1] == 'Y':     #python2
            #    lowD = int(recv[2].encode('hex'), 16)      
            #    highD = int(recv[3].encode('hex'), 16)
            #    lowS = int(recv[4].encode('hex'), 16)      
            #    highS = int(recv[5].encode('hex'), 16)
            #    distance = lowD + highD * 256
            #    strength = lowS + highS * 256
            #    print(distance, strength)
                
            
            # you can also distinguish python2 and python3: 
            #import sys
            #sys.version[0] == '2'    #True, python2
            #sys.version[0] == '3'    #True, python3


if __name__ == '__main__':
    try:
        if ser.is_open == False:
            ser.open()
        getTFminiData()
    except KeyboardInterrupt:   # Ctrl+C
        if ser != None:
            ser.close()

Code: Select all

import serial
import math
from mpl_toolkits.mplot3d import Axes3D
import matplotlib.pyplot as plt
import numpy as np

ser = serial.Serial('/dev/ttyUSB0', 115200, timeout=1)
xlist = []
ylist = []
zlist = []
phi = 0

while phi <= math.pi:

    data = ser.readline()
    print(data)

    if len(data) is 11:
        theta = ""
        phi = ""
        dist = ""
        for i in range(3):
            theta += data[i]
        for i in range(3, 6):
            phi += data[i]
        for i in range(6, 10):
            dist += data[i]

        theta = int(theta) * math.pi / 180
        phi = int(phi) * math.pi / 180
        dist = int(dist)

        x = dist * math.sin(phi) * math.cos(theta)
        y = dist * math.sin(phi) * math.sin(theta)
        z = dist * math.cos(phi)

        xlist.append(x)
        ylist.append(y)
        zlist.append(z)

('      \n'
 'print (xlist)\n'
 'print \n'
 'print ylist\n'
 'print\n'
 'print zlist\n'
 'print\n')

fig = plt.figure()
ax = fig.add_subplot(111, projection='3d')
plt.xlim((-300, 300))
plt.ylim((-300, 300))

ax.scatter(xlist, ylist, zlist)
plt.show()

Code: Select all

multiple access on port?)