CopterExpress/clover
1
0
Fork 0
mirror of https://github.com/CopterExpress/clover.git synced 2026-05-26 21:19:35 +00:00
Code Issues Packages Projects Releases Wiki Activity

snippet: correct formula for calculating angle to horizon

Browse Source
This commit is contained in:
Oleg Kalachev
2018-09-12 23:35:53 +03:00
parent ed51b826a0
commit 8aeb11f771
1 changed files with 4 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
docs/snippets.md
View File

@@ -86,12 +86,14 @@ flipped = not -pi_2 <= telem.pitch <= pi_2 or not -pi_2 <= telem.roll <= pi_2
Рассчет общего угла коптера к горизонту:
TODO: fix
```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
angle_to_horizon = math.atan(math.hypot(math.tan(telem.pitch), math.tan(telem.roll)))
if flipped:
angle_to_horizon = math.pi - angle_to_horizon
```
---