wonderful
/
usvcontrol
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Fix misssion and waypoint mode bug 

Signed-off-by
This commit is contained in:
STT 2021-12-16 14:39:34 +08:00
parent 65ad9d8b26
commit 37522f7841
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
control.py
View File

@ -24,9 +24,10 @@ class Control:
self.battery = 0
def update(self, usv):
self.point_current = Point(usv.navigation.data['location']['latitude'],
usv.navigation.data['location']['longitude'])
self.point_desired = Point(usv.gcs.command['desired_latitude'], usv.gcs.command['desired_longitude'])
self.point_current = Point(radians_to_degrees(usv.navigation.data['location']['latitude']),
radians_to_degrees(usv.navigation.data['location']['longitude']))
self.point_desired = Point(radians_to_degrees(usv.gcs.command['desired_latitude']),
radians_to_degrees(usv.gcs.command['desired_longitude']))
def c_run(self, usv):
self.update(usv)