Add stub algorithm to control car with lidar

This commit is contained in:
Piv
2020-01-20 21:33:56 +10:30
parent 01591a0616
commit 23a7d1cf8b

View File

@@ -104,4 +104,12 @@ def assign_groups(prev_groups, new_groups):
if ((new_centre[0] - old_centre[0]) ** 2 + (new_centre[1] - old_centre[1]) ** 2) < 50 ** 2:
new_group.set_number(group.get_number())
return new_groups
return new_groups
def updateCarVelocity(oldGroup, newGroup):
'''
Return a tuple (throttleChange, steeringChange) that should be
applied given the change in the centre of the groups.
'''
pass