def get_connection_gatt(controller='hci0', hub_mac=None):
from pylgbst.comms.cgatt import GattConnection
return GattConnection(controller).connect(hub_mac)
def test_conn(self):
try:
obj = GattConnection()
obj.connect()
except AttributeError:
pass
linear_velocity = 0.5 * (left_wheel_speed + left_wheel_speed)
right_wheel_speed_lst.append(right_wheel_speed)
left_wheel_speed_lst.append(left_wheel_speed)
hub.motor_AB.start_speed(speed_primary=right_wheel_speed,
speed_secondary=left_wheel_speed)
# print("speed_right = {}".format(right_wheel_speed))
# print("speed_left = {}".format(left_wheel_speed))
if __name__ == '__main__':
try:
HUB_MAC = '00:16:53:A8:E1:8D' # MAC-Adresse des MoveHubs
conn = GattConnection("hci0")
conn.connect(
HUB_MAC
) # you can pass Hub mac address as parameter here, like 'AA:BB:CC:DD:EE:FF'
hub = MoveHub(conn)
if (hub != None):
print("Connected")
sub_pose()
else:
print("Connection error")
#PLOTS:
plot1 = plt.figure(1)
plt.plot(x_lst, y_lst)