Add ultrasonic sensor
This commit is contained in:
@@ -196,7 +196,15 @@ class Raspbot():
|
||||
except:
|
||||
print ('Ctrl_getDis_Switch I2C error')
|
||||
|
||||
|
||||
def Read_Ultrasonic(self):
|
||||
try:
|
||||
diss_H = self.read_data_array(0x1b, 1)[0]
|
||||
diss_L = self.read_data_array(0x1a, 1)[0]
|
||||
dis = (diss_H << 8) | diss_L
|
||||
return dis
|
||||
except:
|
||||
print('Read_Ultrasonic I2C error')
|
||||
return None
|
||||
|
||||
|
||||
#控制灯珠特效
|
||||
|
||||
Reference in New Issue
Block a user