Spiri
/
ROSBuzz_MISTLab
12
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

goto fixes

This commit is contained in:
David St-Onge 2017-01-27 00:12:20 -05:00
parent 37cf9aea6c
commit 1f57b2b7db
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/buzzuav_closures.cpp
View File

@ -83,7 +83,7 @@ int buzzros_print(buzzvm_t vm) {
z = cartesian_pos_payload[2]; z = cartesian_pos_payload[2];
try { try {
out[2]=sqrt(pow(x,2.0)+pow(y,2.0)+pow(z,2.0))-6371000; out[2]=sqrt(pow(x,2.0)+pow(y,2.0)+pow(z,2.0))-6371000;
out[1]=atan2(y,x)*180/M_PI; out[1]=atan2(x,y)*180/M_PI;
out[0]=atan2((sqrt(pow(x,2.0)+pow(y,2.0))),z)*180/M_PI; out[0]=atan2((sqrt(pow(x,2.0)+pow(y,2.0))),z)*180/M_PI;
} catch (std::overflow_error e) { } catch (std::overflow_error e) {
// std::cout << e.what() << " Error in convertion to spherical coordinate system "<<endl; // std::cout << e.what() << " Error in convertion to spherical coordinate system "<<endl;