#include <labust/navigation/KFCore.hpp>
#include <labust/navigation/LDTravModel.hpp>
#include <labust/math/NumberManipulation.hpp>
#include <labust/tools/GeoUtilities.hpp>
#include <labust/tools/MatrixLoader.hpp>
#include <labust/tools/conversions.hpp>
#include <labust/tools/DynamicsLoader.hpp>
#include <labust/simulation/DynamicsParams.hpp>
#include <labust/navigation/KFModelLoader.hpp>
#include <kdl/frames.hpp>
#include <auv_msgs/NavSts.h>
#include <auv_msgs/BodyForceReq.h>
#include <nav_msgs/Odometry.h>
#include <sensor_msgs/NavSatFix.h>
#include <sensor_msgs/Imu.h>
#include <sensor_msgs/FluidPressure.h>
#include <geometry_msgs/TwistStamped.h>
#include <tf/transform_broadcaster.h>
#include <tf/transform_listener.h>
#include <ros/ros.h>
#include <boost/bind.hpp>
#include <sstream>
Go to the source code of this file.
Typedefs | |
typedef labust::navigation::KFCore < labust::navigation::LDTravModel > | KFNav |
Functions | |
void | configureNav (KFNav &nav, ros::NodeHandle &nh) |
double | g_acc (9.81) |
void | handleDvl (KFNav::vector &measurement, KFNav::vector &newFlag, const geometry_msgs::TwistStamped::ConstPtr &data) |
void | handleGPS (KFNav::vector &measurement, KFNav::vector &newFlag, const sensor_msgs::NavSatFix::ConstPtr &data) |
void | handleImu (KFNav::vector &rpy, const sensor_msgs::Imu::ConstPtr &data) |
void | handlePressure (KFNav::vector &measurement, KFNav::vector &newFlag, const std_msgs::Float32::ConstPtr &data) |
void | handleTau (KFNav::vector &tauIn, const auv_msgs::BodyForceReq::ConstPtr &tau) |
int | main (int argc, char *argv[]) |
double | rho (1025) |
Variables | |
tf::TransformListener * | listener |
ros::Time | t |
Definition at line 65 of file nav_node.cpp.
void configureNav | ( | KFNav & | nav, |
ros::NodeHandle & | nh | ||
) |
Definition at line 160 of file nav_node.cpp.
double g_acc | ( | 9. | 81 | ) |
void handleDvl | ( | KFNav::vector & | measurement, |
KFNav::vector & | newFlag, | ||
const geometry_msgs::TwistStamped::ConstPtr & | data | ||
) |
Definition at line 142 of file nav_node.cpp.
void handleGPS | ( | KFNav::vector & | measurement, |
KFNav::vector & | newFlag, | ||
const sensor_msgs::NavSatFix::ConstPtr & | data | ||
) |
Definition at line 79 of file nav_node.cpp.
void handleImu | ( | KFNav::vector & | rpy, |
const sensor_msgs::Imu::ConstPtr & | data | ||
) |
Definition at line 109 of file nav_node.cpp.
void handlePressure | ( | KFNav::vector & | measurement, |
KFNav::vector & | newFlag, | ||
const std_msgs::Float32::ConstPtr & | data | ||
) |
Definition at line 153 of file nav_node.cpp.
void handleTau | ( | KFNav::vector & | tauIn, |
const auv_msgs::BodyForceReq::ConstPtr & | tau | ||
) |
Definition at line 71 of file nav_node.cpp.
int main | ( | int | argc, |
char * | argv[] | ||
) |
Definition at line 192 of file nav_node.cpp.
double rho | ( | 1025 | ) |
Definition at line 66 of file nav_node.cpp.
Definition at line 68 of file nav_node.cpp.