nav_node2.cpp File Reference

#include <labust/navigation/KFCore.hpp>
#include <labust/navigation/XYModel.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 <auv_msgs/NavSts.h>
#include <auv_msgs/BodyForceReq.h>
#include <sensor_msgs/NavSatFix.h>
#include <sensor_msgs/Imu.h>
#include <geometry_msgs/TransformStamped.h>
#include <geometry_msgs/TwistStamped.h>
#include <tf2_ros/buffer.h>
#include <tf2_ros/transform_listener.h>
#include <tf2_ros/transform_broadcaster.h>
#include <Eigen/Dense>
#include <ros/ros.h>
#include <boost/bind.hpp>
#include <sstream>
#include <fstream>

Include dependency graph for nav_node2.cpp:

Go to the source code of this file.

Typedefs
typedef labust::navigation::KFCore < labust::navigation::XYModel >	KFNav
Functions
void	configureNav (KFNav &nav, ros::NodeHandle &nh)
void	handleGPS (KFNav::vector &xy, const sensor_msgs::NavSatFix::ConstPtr &data)
void	handleImu (KFNav::vector &rpy, const sensor_msgs::Imu::ConstPtr &data)
void	handleTau (KFNav::vector &tauIn, const auv_msgs::BodyForceReq::ConstPtr &tau)
int	main (int argc, char *argv[])
KFNav::vector	measurement (KFNav::vector::Zero(KFNav::stateNum))
KFNav::vector	newMeas (KFNav::vector::Zero(KFNav::stateNum))
void	offline_sim (const std::string &filename, KFNav &ekf)
Variables
tf2_ros::Buffer	buffer
tf2_ros::TransformListener *	listener
ros::Time	t

---

Typedef Documentation

typedef labust::navigation::KFCore<labust::navigation::XYModel> KFNav

Definition at line 65 of file nav_node2.cpp.

---

Function Documentation

void configureNav	(	KFNav &	nav,
		ros::NodeHandle &	nh
	)

Definition at line 161 of file nav_node2.cpp.

void handleGPS	(	KFNav::vector &	xy,
		const sensor_msgs::NavSatFix::ConstPtr &	data
	)

Definition at line 79 of file nav_node2.cpp.

void handleImu	(	KFNav::vector &	rpy,
		const sensor_msgs::Imu::ConstPtr &	data
	)

Definition at line 115 of file nav_node2.cpp.

void handleTau	(	KFNav::vector &	tauIn,
		const auv_msgs::BodyForceReq::ConstPtr &	tau
	)

Definition at line 72 of file nav_node2.cpp.

int main	(	int	argc,
		char *	argv[]
	)

Definition at line 282 of file nav_node2.cpp.

KFNav::vector measurement

(

KFNav::vector::

ZeroKFNav::stateNum

)

KFNav::vector newMeas

(

KFNav::vector::

ZeroKFNav::stateNum

)

void offline_sim	(	const std::string &	filename,
		KFNav &	ekf
	)

Definition at line 188 of file nav_node2.cpp.

---

Variable Documentation

tf2_ros::Buffer buffer

Definition at line 66 of file nav_node2.cpp.

tf2_ros::TransformListener* listener

Definition at line 67 of file nav_node2.cpp.

ros::Time t

Definition at line 69 of file nav_node2.cpp.