Hesham/room_scan_sim
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

basictypes: working well with lines

Browse Source 
Signed-off-by: HeshamTB <hishaminv@gmail.com>
This commit is contained in:
HeshamTB 2022-01-25 22:26:15 +03:00
parent 5d73bca7ba
commit 80733cbedb
Signed by: Hesham
GPG Key ID: 74876157D199B09E
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
basictypes.py
View File

@ -74,11 +74,15 @@ class Line:
class WallIDMismatch (RuntimeError): ... class WallIDMismatch (RuntimeError): ...
# Helper methods # Helper methods
def polar_to_cart(self, r, theta_deg) -> tuple: def polar_to_cart(r, theta_deg) -> tuple:
#print('polar to cart ',r, theta_deg) #print('polar to cart ',r, theta_deg)
x = r * math.cos(deg_to_rad(theta_deg)) x = r * math.cos(deg_to_rad(theta_deg))
y = r * math.sin(deg_to_rad(theta_deg)) y = r * math.sin(deg_to_rad(theta_deg))
return x,y return x,y
def deg_to_rad(theta_deg) -> float: def deg_to_rad(theta_deg) -> float:
return theta_deg*(math.pi/180) return theta_deg*(math.pi/180)
def point_from_polar(r, theta, wall_id) -> PointWithID:
x, y = polar_to_cart(r, theta)
return PointWithID(x, y, wall_id)