From 7b5538c104d0eddffdaf5f6394376d6ba9a74c1a Mon Sep 17 00:00:00 2001 From: Oleg Kalachev Date: Thu, 12 Apr 2018 20:20:26 +0300 Subject: [PATCH] docs: circle snippet --- docs/snippets.md | 22 ++++++++++++++++++++++ 1 file changed, 22 insertions(+) diff --git a/docs/snippets.md b/docs/snippets.md index 614fca24..1c9eb24b 100644 --- a/docs/snippets.md +++ b/docs/snippets.md @@ -67,6 +67,28 @@ angle_to_horizon = math.atan(math.hypot(math.tan(telem.pitch), math.tan(telem.ro --- +Полет по круговой траектории: + +```python +RADIUS = 0.6 # m +SPEED = 0.3 # rad / s + +start = get_telemetry() +start_stamp = rospy.get_rostime() + +r = rospy.Rate(10) + +while not rospy.is_shutdown(): + t = (rospy.get_rostime() - start_stamp).to_sec() * SPEED + x = start.x + math.sin(t) * RADIUS + y = start.y + math.cos(t) * RADIUS + set_position(x=x, y=y, z=start.z) + + r.sleep() +``` + +--- + Запуск полётной программы с пульта: ```python