diff --git a/src/axis_imu.cc b/src/axis_imu.cc index 24b015b177c3c8a2bad37e6dbbf121ea7fca21da..8e47ef74493555eab0706855050b9e08a1263380 100644 --- a/src/axis_imu.cc +++ b/src/axis_imu.cc @@ -23,21 +23,8 @@ sensor_msgs::Imu imu_msg; boost::mutex mutex; -// 1 byte header ('A' eller 'G') | float64 timestamp | float64 x | float64 y | float64 z -// -// Headern 'A' och 'G' står för accelerometer respektive gyro. -// timestamp är sekunder sedan kamerans uppstart -// x, y och z är i grader/s för gyrot och G för accelerometern. -// // Data sent in network byte order // -// Jag använder följande curl-kommando för att starta -// curl --digest "[http://root:pass@[IP]/local/motionloggerudp/control.cgi?cmd=start&target_ip=10.92.1.19&accel_enabled=1&accel_rate_div=0&gyro_enabled=1&gyro_rate_div=0]http://root:pass@[IP]/local/motionloggerudp/control.cgi?cmd=start&target_ip=10.92.1.19&accel_enabled=1&accel_rate_div=0&gyro_enabled=1&gyro_rate_div=0" -// -// För att starta motionloggerudp (som är vad jag har kallat den nya varianten som inte lagrar på SD-kort) så anropar man t.ex. -// http://[CAMERAIP]/local/motionloggerudp/control.cgi?cmd=start&target_ip=[TARGETIP]&accel_enabled=1&accel_rate_div=0&gyro_enabled=1&gyro_rate_div=0 -// -// Max sample rate för gyrot är 2kHz och för accelerometern 1kHz, och detta styrs med gyro_rate_div och accel_rate_div i ovanstående http-anrop. // // Fix rate ut, 1kHz @@ -54,7 +41,7 @@ void handler(const boost::system::error_code& error, } void spin_thread () { - ROS_ERROR("Before Spin in spin_thread"); + // ROS_ERROR("Before Spin in spin_thread"); ros::spin(); } @@ -124,11 +111,11 @@ private: az = bytesToDouble(58); if (recv_buffer_[0] == 'G') { have_gyro_flag = true; - ROS_ERROR(" GYRO: %f - %f %f %f", gtime, gx, gy, gz); + // ROS_ERROR(" GYRO: %f - %f %f %f", gtime, gx, gy, gz); } if (recv_buffer_[33] == 'A') { have_acc_flag = true; - ROS_ERROR("ACCELEROMETER: %f - %f %f %f", atime, ax, ay, az); + // ROS_ERROR("ACCELEROMETER: %f - %f %f %f", atime, ax, ay, az); } if (!have_gyro_flag) { @@ -321,7 +308,7 @@ int main(int argc, char *argv[]) { boost::thread sthread (spin_thread); - ROS_ERROR("runUDPServer"); + ROS_INFO("runUDPServer"); runUDPServer(port);