Spiri
/
ROSBuzz_MISTLab
13
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:18:47 -05:00
parent 1f57b2b7db
commit efbbeac1ce
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/buzzuav_closures.cpp
View File

@ -83,8 +83,8 @@ 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(x,y)*180/M_PI; out[1]=atan2(y,x)*180/M_PI;
out[0]=atan2((sqrt(pow(x,2.0)+pow(y,2.0))),z)*180/M_PI; out[0]=atan2(z,(sqrt(pow(x,2.0)+pow(y,2.0))))*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;
} }