PyLidar3 is python 3 package to get data from Lidar device. Currently supports ydlidar from www.ydlidar.com/.
Source code is available on github's repository.
https://github.com/TelecomParistoc/PyLidar3/blob/master/PyLidar3/__init.py__
- pyserial
- time
- math
- enum
You can install using setup.py file from git repository.
This package consists of multiple classes representing the version of lidar you are using. The class structure is YdLidarX4 where X4 is version name ydlidar. Further contribution are actively accepted.
Arguments
: port, chunk_size(default:6000).
port
: serial port to which device is connected. Example: com4, /dev/ttyAMC0.
chunk_size
: Number of bytes of data read from device. Increase in chunk_size results in more averaged angle:distance pairs but increase response time result in slower data acquisition. For faster data acquisition decrease chunk_size.
Note: Calibrate chunk size depends on your application and frequency of device.
if the chunk size is not enough not all angles are covered.
-
Connect
-- Begin serial connection with Lidar by opening serial port. Return success status True/False. -
StartScanning
-- Begin the lidar and returns a generator which returns a dictionary consisting angle(degrees) and distance(meters).
Return Format
: {angle(0):distance, angle(2):distance,....................,angle(359):distance} -
StopScanning
-- Stops scanning but keeps serial connection alive. -
GetHealthStatus
-- Returns True if Health of lidar is good else returns False -
GetDeviceInfo
-- Returns Information of Lidar version, serial number etc. -
Reset
-- Reboot the lidar -
Disconnect
-- Stop scanning and close serial communication with Lidar.
Arguments
: port, chunk_size(default:6000).
port
: serial port to which device is connected. Example: com4, /dev/ttyAMC0.
chunk_size
: Number of bytes of data read from device. Increase in chunk_size results in more averaged angle:distance pairs but increase response time result in slower data acquisition. For faster data acquisition decrease chunk_size.
Note: Calibrate chunk size depends on your application and frequency of device.
if the chunk size is not enough not all angles are covered.
-
Connect
-- Begin serial connection with Lidar by opening serial port. Return success status True/False. -
StartScanning
-- Begin the lidar and returns a generator which returns a dictionary consisting angle(degrees) and distance(meters).
Return Format
: {angle(0):distance, angle(2):distance,....................,angle(359):distance} -
StopScanning
-- Stops scanning but keeps serial connection alive. -
GetHealthStatus
-- Returns True if Health of lidar is good else returns False -
GetDeviceInfo
-- Returns Information of Lidar version, serial number etc. -
EnableLowPowerMode
-- Enable Low Power Consumption Mode(Turn motor and distance-measuring unit off in StopScanning). -
DisableLowPowerMode
-- Disable Low Power Consumption Mode(Turn motor and distance-measuring unit on StopScanning). -
GetLowPowerModeStatus
-- Return True if Low Power Consumption Mode is Enable else return False.
class FrequencyStep(Enum):
oneTenthHertz=1
oneHertz=2
-
IncreaseCurrentFrequency
-- Increase current frequency by oneTenth or one depends on enum FrequencyStep. -
DecreaseCurrentFrequency
-- Decrease current frequency by oneTenth or one depends on enum FrequencyStep.
import PyLidar3
port = input("Enter port name which lidar is connected:") #windows
Obj = PyLidar3.YdLidarG4(port)
if(Obj.Connect()):
print(Obj.GetDeviceInfo())
print(Obj.GetCurrentFrequency())
Obj.IncreaseCurrentFrequency(PyLidar3.FrequencyStep.oneTenthHertz)
print(Obj.GetCurrentFrequency())
Obj.DecreaseCurrentFrequency(PyLidar3.FrequencyStep.oneHertz)
print(Obj.GetCurrentFrequency())
Obj.Disconnect()
else:
print("Error connecting to device")
-
EnableConstantFrequency
-- Enables constant frequency default Enable. -
DisableConstantFrequency
-- Disable constant frequency. -
SwitchRangingFrequency
-- Switch between ranging frequencies 4khz, 8khz and 9khz, default 9khz. -
GetCurrentRangingFrequency
-- Returns current Ranging Frequency in khz. -
Reset
-- Reboot the lidar -
Disconnect
-- Stop scanning and close serial communication with Lidar.
This Example prints data from lidar
import PyLidar3
import time # Time module
#Serial port to which lidar connected, Get it from device manager windows
#In linux type in terminal -- ls /dev/tty*
port = input("Enter port name which lidar is connected:") #windows
#port = "/dev/ttyUSB0" #linux
Obj = PyLidar3.YdLidarX4(port) #PyLidar3.your_version_of_lidar(port,chunk_size)
if(Obj.Connect()):
print(Obj.GetDeviceInfo())
gen = Obj.StartScanning()
t = time.time() # start time
while (time.time() - t) < 30: #scan for 30 seconds
print(next(gen))
time.sleep(0.5)
Obj.StopScanning()
Obj.Disconnect()
else:
print("Error connecting to device")
This Example plot the data. This example needs matplotlib library.
import threading
import PyLidar3
import matplotlib.pyplot as plt
import math
import time
def draw():
global is_plot
while is_plot:
plt.figure(1)
plt.cla()
plt.ylim(-9000,9000)
plt.xlim(-9000,9000)
plt.scatter(x,y,c='r',s=8)
plt.pause(0.001)
plt.close("all")
is_plot = True
x=[]
y=[]
for _ in range(360):
x.append(0)
y.append(0)
port = input("Enter port name which lidar is connected:") #windows
Obj = PyLidar3.YdLidarX4(port) #PyLidar3.your_version_of_lidar(port,chunk_size)
threading.Thread(target=draw).start()
if(Obj.Connect()):
print(Obj.GetDeviceInfo())
gen = Obj.StartScanning()
t = time.time() # start time
while (time.time() - t) < 30: #scan for 30 seconds
data = next(gen)
for angle in range(0,360):
if(data[angle]>1000):
x[angle] = data[angle] * math.cos(math.radians(angle))
y[angle] = data[angle] * math.sin(math.radians(angle))
is_plot = False
Obj.StopScanning()
Obj.Disconnect()
else:
print("Error connecting to device")