Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-11 17:13:56 -03:00
Code Issues Packages Projects Releases Wiki Activity

AP_Math: geodesic_grid tool: show triangle number for sections too

Browse Source
This commit is contained in:
Gustavo Jose de Sousa 2016-05-12 20:27:24 -03:00 committed by Lucas De Marchi
parent a6deb65d95
commit ef61096e08
1 changed files with 12 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
libraries/AP_Math/tools/geodesic_grid/plot.py
View File

@ -56,6 +56,7 @@ def sections(sections):
def show(subtriangles=False):
polygons = []
facecolors = []
triangles_indexes = set()
subtriangle_facecolors = (
'#CCCCCC',
@ -77,17 +78,12 @@ def show(subtriangles=False):
if subtriangles:
sections(range(i * 4, i * 4 + 4))
else:
triangles_indexes.add(i)
polygons.append(p)
facecolors.append('#DDDDDD')
mx = my = mz = 0
for x, y, z in p:
mx += x
my += y
mz += z
ax.text(mx / 2.6, my /2.6, mz / 2.6, i, color='#444444')
for s in added_sections:
triangles_indexes.add(int(s / 4))
subtriangle_index = s % 4
polygons.append(grid.section_triangle(s))
facecolors.append(subtriangle_facecolors[subtriangle_index])
@ -98,6 +94,15 @@ def show(subtriangles=False):
edgecolors="#777777",
))
for i in triangles_indexes:
t = ico.triangles[i]
mx = my = mz = 0
for x, y, z in t:
mx += x
my += y
mz += z
ax.text(mx / 2.6, my / 2.6, mz / 2.6, i, color='#444444')
if subtriangles:
ax.legend(
handles=tuple(