import os
import sys
#import math
import rospy
#import message_filters
from std_msgs.msg import String
from geometry_msgs.msg import Pose



def talker():
    pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)

    rospy.init_node('robot_pose', anonymous=True)

    rate = rospy.Rate(1) # 10hz

    print("starting ...")

    while not rospy.is_shutdown():

        p = Pose()

#        print("Enter a point (x,y,z): ")
#        x, y, z = [float(x) for x in raw_input().split()]
        x, y, z = raw_input("Enter a point (x,y,z): ").split(',')

        # get the position
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)

        # Make sure the quaternion is valid and normalized
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0

        print("Point (x, y, z): {}, {}, {}".format(x, y, z))

        pose_pub.publish(p)

#        hello_str = "hello world %s" % rospy.get_time()
#        rospy.loginfo(hello_str)
#        pub.publish(hello_str)
        rate.sleep()

if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass


'''
class test_pose():

    def __init__(self):
        self._pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)


    def callback(self):
        p = Pose()

        x, y, z = input("Enter a point (x,y,z): ").split()

        # get the position
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)

        # Make sure the quaternion is valid and normalized
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0

        print("Point (x, y, z): {}, {}, {}".format(x, y, z))

        self._pose_pub.publish(p)

    def main(self):
        print("starting rospy")
        rospy.spin()


if __name__ == '__main__':

    rospy.init_node('test_pose_pub')
    tp = test_pose()
    tp.main()




while(1):
    x, y, z = input("Enter a point (x,y,z): ").split()
    
    x = float(x)
    y = float(y)
    z = float(z)
    
    print("Point (x, y, z): {}, {}, {}".format(x, y, z))
    
'''
 

19419d3d43cb8e57a6005bc5df9e31a85aeffe79
<mask token>

<mask token>


def talker():
    pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)
    rospy.init_node('robot_pose', anonymous=True)
    rate = rospy.Rate(1)
    print('starting ...')
    while not rospy.is_shutdown():
        p = Pose()
        x, y, z = raw_input('Enter a point (x,y,z): ').split(',')
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0
        print('Point (x, y, z): {}, {}, {}'.format(x, y, z))
        pose_pub.publish(p)
        rate.sleep()


<mask token>

<mask token>


def talker():
    pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)
    rospy.init_node('robot_pose', anonymous=True)
    rate = rospy.Rate(1)
    print('starting ...')
    while not rospy.is_shutdown():
        p = Pose()
        x, y, z = raw_input('Enter a point (x,y,z): ').split(',')
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0
        print('Point (x, y, z): {}, {}, {}'.format(x, y, z))
        pose_pub.publish(p)
        rate.sleep()


if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass
<mask token>

import os
import sys
import rospy
from std_msgs.msg import String
from geometry_msgs.msg import Pose


def talker():
    pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)
    rospy.init_node('robot_pose', anonymous=True)
    rate = rospy.Rate(1)
    print('starting ...')
    while not rospy.is_shutdown():
        p = Pose()
        x, y, z = raw_input('Enter a point (x,y,z): ').split(',')
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0
        print('Point (x, y, z): {}, {}, {}'.format(x, y, z))
        pose_pub.publish(p)
        rate.sleep()


if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass
<mask token>

import os
import sys
#import math
import rospy
#import message_filters
from std_msgs.msg import String
from geometry_msgs.msg import Pose



def talker():
    pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)

    rospy.init_node('robot_pose', anonymous=True)

    rate = rospy.Rate(1) # 10hz

    print("starting ...")

    while not rospy.is_shutdown():

        p = Pose()

#        print("Enter a point (x,y,z): ")
#        x, y, z = [float(x) for x in raw_input().split()]
        x, y, z = raw_input("Enter a point (x,y,z): ").split(',')

        # get the position
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)

        # Make sure the quaternion is valid and normalized
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0

        print("Point (x, y, z): {}, {}, {}".format(x, y, z))

        pose_pub.publish(p)

#        hello_str = "hello world %s" % rospy.get_time()
#        rospy.loginfo(hello_str)
#        pub.publish(hello_str)
        rate.sleep()

if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass


'''
class test_pose():

    def __init__(self):
        self._pose_pub = rospy.Publisher('robot_pose', Pose, queue_size=1)


    def callback(self):
        p = Pose()

        x, y, z = input("Enter a point (x,y,z): ").split()

        # get the position
        p.position.x = float(x)
        p.position.y = float(y)
        p.position.z = float(z)

        # Make sure the quaternion is valid and normalized
        p.orientation.x = 0.0
        p.orientation.y = 0.0
        p.orientation.z = 0.0
        p.orientation.w = 1.0

        print("Point (x, y, z): {}, {}, {}".format(x, y, z))

        self._pose_pub.publish(p)

    def main(self):
        print("starting rospy")
        rospy.spin()


if __name__ == '__main__':

    rospy.init_node('test_pose_pub')
    tp = test_pose()
    tp.main()




while(1):
    x, y, z = input("Enter a point (x,y,z): ").split()
    
    x = float(x)
    y = float(y)
    z = float(z)
    
    print("Point (x, y, z): {}, {}, {}".format(x, y, z))
    
'''
 
