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())
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())