use pointer to odometry message

edit

I've been stuck on a problem for quite a while now. I'm trying to use multiple files (main function file, file containing different movement control functions, file for controlling the camera, etc... and header files) in order to make control my turtlebot. When I only use publishers and don't bother subscribing to any nodes, everything seems to work fine, including moving the turtlebot solely with publish commands, however when I try and use a subscriber to change what the motion will be depending on speed everything seems to fail.

My CMake list is fine and everything compiles correctly, but when I run it I get the following error:

/usr/include/boost/smart_ptr/shared_ptr.hpp:648: typename boost::detail::sp_member_access<t>::type boost::shared_ptr<t>::operator->() const [with T = const nav_msgs::Odometry_<std::allocator<void>

; typename boost::detail::sp_member_access<t>::type = const nav_msgs::Odometry_<std::allocator<void> *]: Assertion `px != 0' failed. Aborted (core dumped)

What I've figured out is that my odometry pointer (odom_ptr) seems to not be initializing, but I'm not sure why or how to fix it. Any help would be greatly appreciated.

For this I'm using the following piece of code:

MainFile.cpp

#include <iostream>
#include <ros/ros.h>
#include <geometry_msgs/Twist.h>
#include <nav_msgs/Odometry.h>
#include <std_msgs/Empty.h>
#include "TurtleFunction.cpp"
#include "TurtleFunction.h"

#include <sstream>
#include <string>
#include <cmath>
#include <math.h>

using namespace std;

/* Define Global Variables
--------------------------*/
// ROS Publishers and Subscribers
ros::Publisher cmd_pub, reset_pub;
ros::Subscriber OdomSub;

// Pointers and Messages
geometry_msgs::Twist cmd_msg;
nav_msgs::Odometry::ConstPtr odom_ptr;
std_msgs::Empty reset_msg ;


int main(int argc, char** argv){

    // Initialize ROS
    ros::init(argc, argv, "test3");
    ros::NodeHandle nh;
    ros::spinOnce();

    // Define Global Variables for use
    cmd_pub = nh.advertise<geometry_msgs::Twist>("/cmd_vel_mux/input/teleop", 10);
    reset_pub = nh.advertise<std_msgs::Empty>("/mobile_base/commands/reset_odometry", 1);
    OdomSub = nh.subscribe<nav_msgs::Odometry>("/odom",50,processodom);

    ros::spinOnce();
    resetOdom(); // Reset the Odometry of the Turtlebot
    ros::spinOnce();

    // Define Initial Velocity Variables for TurtleBot
    double v = 0.1;
    double theta = 0.01;

    int i = 0;

    while(1){
        // Movement(v,theta);
        UnicycleModel();
        cout << "this is working" << i << endl;
        i++;
    }

    cout << "This worked" << endl;

    return 0;
}

Then I have the following function file:

TurtleFunction.cpp

#include <iostream>
#include <ros/ros.h>
#include <geometry_msgs/Twist.h>
#include <nav_msgs/Odometry.h>
#include <std_msgs/Empty.h>
#include "TurtleFunction.h"


#include <sstream>
#include <string>
#include <cmath>
#include <math.h>

using namespace std;

void Movement(double v,double theta){

    // geometry_msgs::Twist cmd_msg;

    cmd_msg.linear.x  = v;
    cout << "v = " << cmd_msg.linear.x << endl;
    cmd_msg.angular.z  = theta;
    cout << "theta = " << cmd_msg.angular.z << endl;
    cmd_pub.publish(cmd_msg); //send

    ros::spinOnce();
}

void UnicycleModel(){

    float pi = 3.14159265359 ;

    float pose_judah_x = odom_ptr->pose.pose.position.x ;
    float pose_judah_y = odom_ptr->pose.pose.position.y ;
    float orientationW = odom_ptr->pose.pose.orientation.w ;
    float orientationX = odom_ptr->pose.pose.orientation.x ;
    float orientationY = odom_ptr->pose.pose.orientation.y ;
    float orientationZ = odom_ptr->pose.pose.orientation.z ;


    float psi_rad = atan2(2*orientationW*orientationZ,1-2*orientationZ*orientationZ) ;
    float psi_deg = psi_rad*180/pi ;

    if ...