Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- z = 1.5
- FIELD_LENGTH_X = 2.83 #in meters
- FIELD_LENGTH_Y = 2.65 #in meters
- deltaX = 0.65 #in meters
- deltaY = 0.25 #in meters
- points = []
- i = 0.1
- count = 0
- # Создание массива с точками для дальнейшего полета по полю (полет по зиг-загу)
- while i <= FIELD_LENGTH_X:
- j = 0.1
- while j <= FIELD_LENGTH_Y:
- if count % 2 == 0:
- points.append((i, j))
- else:
- points.append((i, FIELD_LENGTH_Y - j))
- j += deltaY
- i += deltaX
- count += 1
- for point in points:
- navigate_wait(x=point[0], y=point[1], z=z, speed=0.4, yaw=3.14/2.0)
- rospy.sleep(0.3)
- # ТУТ РАСПОЗНАВАНИЕ
- rospy.sleep(0.3)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement