/home/joel/ros_workspace/lar3/perception/parking_detection/src/pub_transformations.cpp

Go to the documentation of this file.

#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <std_msgs/Float64.h>
#include <math.h>

int main(int argc, char** argv){
        ros::init(argc, argv, "pub_transformations");
        ros::NodeHandle n;
        tf::TransformBroadcaster broadcaster;
        ros::Rate r(10);
        
    float alpha=(38.5)*(M_PI/180);// 38.5 is obtained by multiplying the tillt angle by -1
        
        tf::Transform transform(btMatrix3x3(0,-1,0, cos(alpha),0,sin(alpha), -sin(alpha),0,cos(alpha)),
                                                        btVector3(0.236, -0.05, 0.68));


        ros::spinOnce();
        while(n.ok())
        {
          broadcaster.sendTransform(tf::StampedTransform(transform, ros::Time::now(),"/vehicle_odometry", "/openni_camera")); 

          r.sleep();
          ros::spinOnce();
        }
}