docs: add some code smippets

This commit is contained in:
Oleg Kalachev
2018-09-12 21:30:55 +03:00
parent 8a9fd2a97c
commit bb84eeb35e

View File

@@ -71,6 +71,17 @@ while True:
rospy.sleep(0.2)
```
--
Определение, перевернут ли коптер:
```python
pi_2 = math.pi / 2
telem = get_telemetry()
flipped = not -pi_2 <= telem.pitch <= pi_2 or not -pi_2 <= telem.roll <= pi_2
```
---
Рассчет общего угла коптера к горизонту:
@@ -107,6 +118,17 @@ while not rospy.is_shutdown():
---
Повторять действие с частотой 10 Гц:
```python
r = rospy.Rate(10)
while not rospy.is_shutdown():
# Do anything
r.sleep()
```
---
Пример подписки на топики из MAVROS: