def send_pose_gps(rid, x,y,z):
    msg = pos_gps_t()
    msg.robotid = rid
    msg.latitude =  y
    msg.longitude = x
    msg.altitude = z
    lc.publish("POSEGPS", msg.encode())
Beispiel #2
0
def send_pose(robotid, longitude, latitude, altitude):
    msg = pos_gps_t()
    channel = "POSGPS"
    msg.robotid = robotid
    msg.longitude = longitude
    msg.latitude = latitude
    msg.altitude = altitude
    lc.publish(channel, msg.encode())
parser = optparse.OptionParser(usage="usage: %prog [options] id lon lat altitude",
                               version="%prog 1.0")
parser.add_option("-c", "--channel",
                  default="POSEGPS",
                  help="lcm channel")


(options, args) = parser.parse_args()
if len(args) != 4:
    print "mandatory arguments missing (",len(args),")"
    parser.print_help()
    exit(-1)


robotid = int(args[0])
lon = float(args[1])
lat = float(args[2])
alt = float(args[3])
"""  --- no orientaion --- """

channel = options.channel
lc = lcm.LCM("udpm://239.255.76.67:7667?ttl=1") 

msg = pos_gps_t()
msg.robotid = robotid
msg.latitude =  lat
msg.longitude = lon
msg.altitude = alt

lc.publish(options.channel, msg.encode())