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

View File

@ -83,7 +83,7 @@ int buzzros_print(buzzvm_t vm) {
z = cartesian_pos_payload[2];
try {
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;
} catch (std::overflow_error e) {
// std::cout << e.what() << " Error in convertion to spherical coordinate system "<<endl;