Processing PoseStamped message as an integer (or something similar)

edit

Hi @bionic_socks,

First of all you will need to know that the PoseStamped msg type already contains the Pose of the robot, that means, position (x,y,z) and orientation (x,y,z,w) in quaternion form. So knowing that, your example is not coherent with this since you are using three PoseStamped objects to store individual pose coordinates. Lets assume you are using only one: vehicle_pose in which you store the full msg refering to the current robot pose.

As the error says, python interpreter is not able to compare the different data types int and PoseStamped, and the static cast to int will not work since the msg instance itself is not a number. Since, with that example, you are working only with x coordinates you will need to extract from the PoseStamped msg, the proper pose coordinate and feed it to your function. Here is a minimal working example of what I think you are trying to achieve:

#! /usr/bin/python

import rospy
import numpy as np
from geometry_msgs.msg import PoseStamped, TwistStamped

vehicle_pose = PoseStamped()

def isclose(a, b, rel_tol=1e-09, abs_tol=0.0):
    return abs(a-b) <= max(rel_tol * max(abs(a), abs(b)), abs_tol)

def local_pose_callback(msg):
    global vehicle_pose
    vehicle_pose = msg

rospy.init_node('practice', anonymous=False)

x_target = int(raw_input('x = '))
y_target = int(raw_input('y = '))

int_vehicle_x= int(vehicle_pose.pose.position.x)

x_tol = isclose(int_vehicle_x, x_target, abs_tol=0.25)

print("isclose returned: " + str(x_tol))

pose_sub = rospy.Subscriber('/mavros/local_position/pose', PoseStamped,
                            local_pose_callback, queue_size = 10)

Hope that helps.