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

lj test

This commit is contained in:
David St-Onge 2017-01-30 17:10:07 -05:00
parent a7f1b0903d
commit f77f6ebe1a
2 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/roscontroller.cpp
View File

@ -423,8 +423,8 @@ namespace rosbzz_node{
z = cartesian_pos_payload[2];
try {
out[0]=sqrt(pow(x,2.0)+pow(y,2.0)+pow(z,2.0));
out[1]=atan2(y,x);
out[2]=atan2((sqrt(pow(x,2.0)+pow(y,2.0))),z);
out[1]=atan2(x,y);
out[2]=atan2(z,(sqrt(pow(x,2.0)+pow(y,2.0))));
} catch (std::overflow_error e) {
std::cout << e.what() << " Error in convertion to spherical coordinate system "<<endl;
}

2
src/test1.bzz
View File

@ -17,7 +17,7 @@ TARGET_ALTITUDE = 10.1
# Lennard-Jones parameters
TARGET = 5 #0.000001001
EPSILON = 800 #0.001
EPSILON = 200 #0.001
# Lennard-Jones interaction magnitude
function lj_magnitude(dist, target, epsilon) {