goto fixes

This commit is contained in:
David St-Onge 2017-01-27 00:00:19 -05:00
parent ab368990d9
commit 37cf9aea6c
1 changed files with 2 additions and 2 deletions

View File

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