Nasupl

import rospkg
import roslaunch

# パッケージパスの取得
rospack = rospkg.RosPack()
pkg_path = rospack.get_path('cit_bringup')
launch_path = path + '/launch/cit.launch'

# uuidの取得とロギング設定
uuid = roslaunch.rlutil.get_or_generate_uuid(None, False)

Nasupl

import rospy
from std_msgs.msg import Header
from geometry_msgs.msg import Pose, Point, Quaternion, PoseWithCovariance, PoseWithCovarianceStamped
from tf.transformations import quaternion_from_euler


def publish_pose(x, y, z, yaw):
    pub = rospy.Publisher('initialpose', PoseWithCovarianceStamped, queue_size=10)
    point = Point(x, y, z)
    q = quaternion_from_euler(0.0, 0.0, yaw).tolist()

Nasupl

before sort
0 3
1 7
2 1
3 2
4 9
5 4
6 6
after sort
2 1