mavlink / mavros

MAVLink to ROS gateway with proxy for Ground Control Station
Other
879 stars 990 forks source link

Set Target Position Issue with APM #946

Closed mellonUAV closed 6 years ago

mellonUAV commented 6 years ago

Hello,

I am trying to control a quadrotor indoors using UWB to localize. Basically UWB gives me x, y, z position data. I have managed to feed this position data as GPS to APM succesfully. Here is my previous issue on this topic: https://github.com/mavlink/mavros/issues/942

Now I am trying to send target position to APM through mavros. I tried sending through /setpoint_raw/global. I published to this topic and set the quadrotor GUIDED mode. APM Planner didn't seem to receive any position target data.

I think I want to publish to SET_POSITION_TARGET_GLOBAL_INT mavlink message because I am working with HIL_GPS. How can I achieve this. I will also try publishing to SET_POSITION_TARGET_LOCAL_NED by using setpoint_position but I am not sure if this method will work form me since I don't have ant x, y, z data on APM.

As I said in the previous issue, I am new to this stuff. Am I doing something wrong here or is there a better method to do this?

Thank you so much for your help!

Best regards, Melih

MAVROS version and platform

Mavros: 0.18.3 (Erle Brain-3) (I am not sure how to properly check this. They say this is the generic version in Erle Brain but I am not sure. I installed mavros to PC by "sudo apt-get ...") ROS: Kinetic Ubuntu: 16.04

Autopilot type and version

[x] ArduPilot [ ] PX4

Version: V3.5.0-rc9 (242c8f0b)

Node logs

~/erle_ws$ roslaunch mavros apm.launch fcu_url:=udp://10.0.0.2:6001@ gcs_url:=tcp-l://
... logging to /home/melih/.ros/log/1d52e220-0bed-11e8-9670-d017c21fd173/roslaunch-melih-N552VW-11985.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://melih-N552VW:35401/

SUMMARY
========

CLEAR PARAMETERS
 * /mavros/

PARAMETERS
 * /mavros/cmd/use_comp_id_system_control: False
 * /mavros/conn/heartbeat_rate: 1.0
 * /mavros/conn/system_time_rate: 0.0
 * /mavros/conn/timeout: 10.0
 * /mavros/conn/timesync_rate: 0.0
 * /mavros/distance_sensor/rangefinder_pub/field_of_view: 0.0
 * /mavros/distance_sensor/rangefinder_pub/frame_id: lidar
 * /mavros/distance_sensor/rangefinder_pub/id: 0
 * /mavros/distance_sensor/rangefinder_pub/send_tf: False
 * /mavros/distance_sensor/rangefinder_pub/sensor_position/x: 0.0
 * /mavros/distance_sensor/rangefinder_pub/sensor_position/y: 0.0
 * /mavros/distance_sensor/rangefinder_pub/sensor_position/z: -0.1
 * /mavros/distance_sensor/rangefinder_sub/id: 1
 * /mavros/distance_sensor/rangefinder_sub/orientation: PITCH_270
 * /mavros/distance_sensor/rangefinder_sub/subscriber: True
 * /mavros/fake_gps/eph: 2.0
 * /mavros/fake_gps/epv: 2.0
 * /mavros/fake_gps/fix_type: 3
 * /mavros/fake_gps/geo_origin/alt: 408.0
 * /mavros/fake_gps/geo_origin/lat: 47.3667
 * /mavros/fake_gps/geo_origin/lon: 8.55
 * /mavros/fake_gps/gps_rate: 5.0
 * /mavros/fake_gps/mocap_transform: True
 * /mavros/fake_gps/satellites_visible: 5
 * /mavros/fake_gps/tf/child_frame_id: fix
 * /mavros/fake_gps/tf/frame_id: map
 * /mavros/fake_gps/tf/listen: False
 * /mavros/fake_gps/tf/rate_limit: 10.0
 * /mavros/fake_gps/tf/send: False
 * /mavros/fake_gps/use_mocap: True
 * /mavros/fake_gps/use_vision: False
 * /mavros/fcu_url: udp://10.0.0.2:6001@
 * /mavros/gcs_url: tcp-l://
 * /mavros/global_position/child_frame_id: base_link
 * /mavros/global_position/frame_id: map
 * /mavros/global_position/rot_covariance: 99999.0
 * /mavros/global_position/tf/child_frame_id: base_link
 * /mavros/global_position/tf/frame_id: map
 * /mavros/global_position/tf/global_frame_id: earth
 * /mavros/global_position/tf/send: False
 * /mavros/global_position/use_relative_alt: True
 * /mavros/image/frame_id: px4flow
 * /mavros/imu/angular_velocity_stdev: 0.000349065850399
 * /mavros/imu/frame_id: base_link
 * /mavros/imu/linear_acceleration_stdev: 0.0003
 * /mavros/imu/magnetic_stdev: 0.0
 * /mavros/imu/orientation_stdev: 1.0
 * /mavros/local_position/frame_id: map
 * /mavros/local_position/tf/child_frame_id: base_link
 * /mavros/local_position/tf/frame_id: map
 * /mavros/local_position/tf/send: False
 * /mavros/local_position/tf/send_fcu: False
 * /mavros/mission/pull_after_gcs: True
 * /mavros/mocap/use_pose: True
 * /mavros/mocap/use_tf: False
 * /mavros/odometry/estimator_type: 3
 * /mavros/odometry/frame_tf/desired_frame: ned
 * /mavros/plugin_blacklist: ['actuator_contro...
 * /mavros/plugin_whitelist: ['mocap_pose_esti...
 * /mavros/px4flow/frame_id: px4flow
 * /mavros/px4flow/ranger_fov: 0.118682389136
 * /mavros/px4flow/ranger_max_range: 5.0
 * /mavros/px4flow/ranger_min_range: 0.3
 * /mavros/safety_area/p1/x: 1.0
 * /mavros/safety_area/p1/y: 1.0
 * /mavros/safety_area/p1/z: 1.0
 * /mavros/safety_area/p2/x: -1.0
 * /mavros/safety_area/p2/y: -1.0
 * /mavros/safety_area/p2/z: -1.0
 * /mavros/setpoint_accel/send_force: False
 * /mavros/setpoint_attitude/reverse_thrust: False
 * /mavros/setpoint_attitude/tf/child_frame_id: target_attitude
 * /mavros/setpoint_attitude/tf/frame_id: map
 * /mavros/setpoint_attitude/tf/listen: False
 * /mavros/setpoint_attitude/tf/rate_limit: 50.0
 * /mavros/setpoint_attitude/use_quaternion: False
 * /mavros/setpoint_position/mav_frame: LOCAL_NED
 * /mavros/setpoint_position/tf/child_frame_id: target_position
 * /mavros/setpoint_position/tf/frame_id: map
 * /mavros/setpoint_position/tf/listen: False
 * /mavros/setpoint_position/tf/rate_limit: 50.0
 * /mavros/setpoint_velocity/mav_frame: LOCAL_NED
 * /mavros/startup_px4_usb_quirk: False
 * /mavros/sys/disable_diag: False
 * /mavros/sys/min_voltage: 10.0
 * /mavros/target_component_id: 1
 * /mavros/target_system_id: 1
 * /mavros/tdr_radio/low_rssi: 40
 * /mavros/time/time_ref_source: fcu
 * /mavros/time/timesync_avg_alpha: 0.6
 * /mavros/time/timesync_mode: NONE
 * /mavros/vibration/frame_id: base_link
 * /mavros/vision_pose/tf/child_frame_id: vision_estimate
 * /mavros/vision_pose/tf/frame_id: map
 * /mavros/vision_pose/tf/listen: False
 * /mavros/vision_pose/tf/rate_limit: 10.0
 * /mavros/vision_speed/listen_twist: False
 * /rosdistro: kinetic
 * /rosversion: 1.12.7

NODES
  /
    mavros (mavros/mavros_node)

auto-starting new master
process[master]: started with pid [11996]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to 1d52e220-0bed-11e8-9670-d017c21fd173
process[rosout-1]: started with pid [12009]
started core service [/rosout]
process[mavros-2]: started with pid [12027]
[ INFO] [1517997366.691099200]: FCU URL: udp://10.0.0.2:6001@
[ WARN] [1517997366.691565635]: init: message from ASLUAV, MSG-ID 201 ignored! Table has different entry.
[ WARN] [1517997366.691722303]: init: message from autoquad, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1517997366.691733709]: init: message from autoquad, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1517997366.691878365]: init: message from matrixpilot, MSG-ID 150 ignored! Table has different entry.
[ WARN] [1517997366.691888515]: init: message from matrixpilot, MSG-ID 151 ignored! Table has different entry.
[ WARN] [1517997366.691896882]: init: message from matrixpilot, MSG-ID 152 ignored! Table has different entry.
[ WARN] [1517997366.691924108]: init: message from matrixpilot, MSG-ID 153 ignored! Table has different entry.
[ WARN] [1517997366.691946185]: init: message from matrixpilot, MSG-ID 155 ignored! Table has different entry.
[ WARN] [1517997366.691957779]: init: message from matrixpilot, MSG-ID 156 ignored! Table has different entry.
[ WARN] [1517997366.691968076]: init: message from matrixpilot, MSG-ID 157 ignored! Table has different entry.
[ WARN] [1517997366.691978622]: init: message from matrixpilot, MSG-ID 158 ignored! Table has different entry.
[ WARN] [1517997366.691988220]: init: message from matrixpilot, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1517997366.691997598]: init: message from matrixpilot, MSG-ID 171 ignored! Table has different entry.
[ WARN] [1517997366.692007024]: init: message from matrixpilot, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1517997366.692016741]: init: message from matrixpilot, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1517997366.692027036]: init: message from matrixpilot, MSG-ID 174 ignored! Table has different entry.
[ WARN] [1517997366.692036557]: init: message from matrixpilot, MSG-ID 175 ignored! Table has different entry.
[ WARN] [1517997366.692046172]: init: message from matrixpilot, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1517997366.692056786]: init: message from matrixpilot, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1517997366.692066472]: init: message from matrixpilot, MSG-ID 178 ignored! Table has different entry.
[ WARN] [1517997366.692076133]: init: message from matrixpilot, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1517997366.692085760]: init: message from matrixpilot, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1517997366.692095418]: init: message from matrixpilot, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1517997366.692124032]: init: message from matrixpilot, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1517997366.692150279]: init: message from matrixpilot, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1517997366.692160313]: init: message from matrixpilot, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1517997366.692170464]: init: message from matrixpilot, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1517997366.692180505]: init: message from matrixpilot, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1517997366.692290273]: init: message from paparazzi, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1517997366.692300473]: init: message from paparazzi, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1517997366.692310530]: init: message from paparazzi, MSG-ID 182 ignored! Table has different entry.
[ WARN] [1517997366.692320520]: init: message from paparazzi, MSG-ID 183 ignored! Table has different entry.
[ WARN] [1517997366.692330683]: init: message from paparazzi, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1517997366.692438124]: init: message from slugs, MSG-ID 170 ignored! Table has different entry.
[ WARN] [1517997366.692448039]: init: message from slugs, MSG-ID 172 ignored! Table has different entry.
[ WARN] [1517997366.692457738]: init: message from slugs, MSG-ID 173 ignored! Table has different entry.
[ WARN] [1517997366.692467889]: init: message from slugs, MSG-ID 176 ignored! Table has different entry.
[ WARN] [1517997366.692477365]: init: message from slugs, MSG-ID 177 ignored! Table has different entry.
[ WARN] [1517997366.692487687]: init: message from slugs, MSG-ID 179 ignored! Table has different entry.
[ WARN] [1517997366.692497295]: init: message from slugs, MSG-ID 180 ignored! Table has different entry.
[ WARN] [1517997366.692507388]: init: message from slugs, MSG-ID 181 ignored! Table has different entry.
[ WARN] [1517997366.692516912]: init: message from slugs, MSG-ID 184 ignored! Table has different entry.
[ WARN] [1517997366.692526954]: init: message from slugs, MSG-ID 185 ignored! Table has different entry.
[ WARN] [1517997366.692536681]: init: message from slugs, MSG-ID 186 ignored! Table has different entry.
[ WARN] [1517997366.692565692]: init: message from slugs, MSG-ID 188 ignored! Table has different entry.
[ WARN] [1517997366.692591011]: init: message from slugs, MSG-ID 191 ignored! Table has different entry.
[ WARN] [1517997366.692613930]: init: message from slugs, MSG-ID 192 ignored! Table has different entry.
[ WARN] [1517997366.692623686]: init: message from slugs, MSG-ID 193 ignored! Table has different entry.
[ WARN] [1517997366.692634022]: init: message from slugs, MSG-ID 194 ignored! Table has different entry.
[ INFO] [1517997366.692945944]: udp0: Bind address: 10.0.0.2:6001
[ INFO] [1517997366.693093821]: GCS URL: tcp-l://
[ INFO] [1517997366.693152870]: tcp1: Bind address: 0.0.0.0:5760
[ INFO] [1517997366.701328547]: Plugin 3dr_radio loaded
[ INFO] [1517997366.703650198]: Plugin 3dr_radio initialized
[ INFO] [1517997366.703677619]: Plugin actuator_control blacklisted
[ INFO] [1517997366.705992915]: Plugin adsb loaded
[ INFO] [1517997366.709673581]: Plugin adsb initialized
[ INFO] [1517997366.709696527]: Plugin altitude blacklisted
[ INFO] [1517997366.709835707]: Plugin cam_imu_sync loaded
[ INFO] [1517997366.710581047]: Plugin cam_imu_sync initialized
[ INFO] [1517997366.710693894]: Plugin command loaded
[ INFO] [1517997366.715226933]: Plugin command initialized
[ INFO] [1517997366.715245429]: Plugin debug_value blacklisted
[ INFO] [1517997366.715378217]: Plugin distance_sensor loaded
[ INFO] [1517997366.723590267]: Plugin distance_sensor initialized
[ INFO] [1517997366.723719023]: Plugin fake_gps loaded
[ INFO] [1517997366.738607885]: Plugin fake_gps initialized
[ INFO] [1517997366.738633634]: Plugin ftp blacklisted
[ INFO] [1517997366.738757590]: Plugin global_position loaded
[ INFO] [1517997366.754559160]: Plugin global_position initialized
[ INFO] [1517997366.754665480]: Plugin hil loaded
[ INFO] [1517997366.768874276]: Plugin hil initialized
[ INFO] [1517997366.769020432]: Plugin home_position loaded
[ INFO] [1517997366.772994187]: Plugin home_position initialized
[ INFO] [1517997366.773113324]: Plugin imu loaded
[ INFO] [1517997366.779480196]: Plugin imu initialized
[ INFO] [1517997366.779597139]: Plugin local_position loaded
[ INFO] [1517997366.784334505]: Plugin local_position initialized
[ INFO] [1517997366.784417850]: Plugin manual_control loaded
[ INFO] [1517997366.785017144]: Plugin manual_control initialized
[ INFO] [1517997366.785099294]: Plugin mocap_pose_estimate loaded
[ INFO] [1517997366.788904387]: Plugin mocap_pose_estimate initialized
[ INFO] [1517997366.788985719]: Plugin odom loaded
[ INFO] [1517997366.792707516]: Plugin odom initialized
[ INFO] [1517997366.792801904]: Plugin param loaded
[ INFO] [1517997366.794688398]: Plugin param initialized
[ INFO] [1517997366.794708898]: Plugin px4flow blacklisted
[ INFO] [1517997366.794772245]: Plugin rangefinder loaded
[ INFO] [1517997366.795242786]: Plugin rangefinder initialized
[ INFO] [1517997366.795321669]: Plugin rc_io loaded
[ INFO] [1517997366.799200405]: Plugin rc_io initialized
[ INFO] [1517997366.799231914]: Plugin safety_area blacklisted
[ INFO] [1517997366.799331119]: Plugin setpoint_accel loaded
[ INFO] [1517997366.802976504]: Plugin setpoint_accel initialized
[ INFO] [1517997366.803086627]: Plugin setpoint_attitude loaded
[ INFO] [1517997366.811196358]: Plugin setpoint_attitude initialized
[ INFO] [1517997366.811287286]: Plugin setpoint_position loaded
[ INFO] [1517997366.823590895]: Plugin setpoint_position initialized
[ INFO] [1517997366.823683687]: Plugin setpoint_raw loaded
[ INFO] [1517997366.832581833]: Plugin setpoint_raw initialized
[ INFO] [1517997366.832698139]: Plugin setpoint_velocity loaded
[ INFO] [1517997366.838170698]: Plugin setpoint_velocity initialized
[ INFO] [1517997366.838269361]: Plugin sys_status loaded
[ INFO] [1517997366.843126303]: Plugin sys_status initialized
[ INFO] [1517997366.843209535]: Plugin sys_time loaded
[ INFO] [1517997366.846046609]: TM: Timesync mode: NONE
[ INFO] [1517997366.846558825]: Plugin sys_time initialized
[ INFO] [1517997366.846640415]: Plugin vfr_hud loaded
[ INFO] [1517997366.847650824]: Plugin vfr_hud initialized
[ INFO] [1517997366.847671188]: Plugin vibration blacklisted
[ INFO] [1517997366.847682077]: Plugin vision_pose_estimate blacklisted
[ INFO] [1517997366.847694115]: Plugin vision_speed_estimate blacklisted
[ INFO] [1517997366.847765601]: Plugin waypoint loaded
[ INFO] [1517997366.851505919]: Plugin waypoint initialized
[ INFO] [1517997366.851535611]: Built-in SIMD instructions: SSE, SSE2
[ INFO] [1517997366.851549188]: Built-in MAVLink package version: 2018.1.1
[ INFO] [1517997366.851573065]: Known MAVLink dialects: common ardupilotmega ASLUAV autoquad matrixpilot paparazzi slugs standard uAvionix ualberta
[ INFO] [1517997366.851592565]: MAVROS started. MY ID 1.240, TARGET ID 1.1
[ INFO] [1517997370.184996852]: udp0: Remote address: 10.0.0.1:56964
[ INFO] [1517997370.217172127]: CON: Got HEARTBEAT, connected. FCU: ArduPilotMega / ArduCopter
[ INFO] [1517997371.246695115]: VER: 1.1: Capabilities         0x0000000000001bcf
[ INFO] [1517997371.246798270]: VER: 1.1: Flight software:     030500c0 (242c8f0b)
[ INFO] [1517997371.246859866]: VER: 1.1: Middleware software: 00000000 (        )
[ INFO] [1517997371.246906546]: VER: 1.1: OS software:         00000000 (        )
[ INFO] [1517997371.246961449]: VER: 1.1: Board hardware:      00000000
[ INFO] [1517997371.247008639]: VER: 1.1: VID/PID:             0000:0000
[ INFO] [1517997371.247122806]: VER: 1.1: UID:                 0000000000000000
[ WARN] [1517997371.247218481]: CMD: Unexpected command 520, result 0
[ INFO] [1517997373.187573195]: FCU: Calibrating barometer
[ INFO] [1517997373.747816550]: FCU: Initialising APM
[ INFO] [1517997374.797044736]: FCU: Barometer calibration complete
[ INFO] [1517997376.627196877]: FCU: EKF2 IMU0 initial yaw alignment complete
[ INFO] [1517997378.067099104]: FCU: EKF2 IMU0 tilt alignment complete
[ INFO] [1517997380.218146715]: HP: requesting home position
[ INFO] [1517997380.258777687]: FCU: APM:Copter V3.5.0-rc9 (242c8f0b)
[ INFO] [1517997380.258926777]: FCU: Frame: QUAD
[ INFO] [1517997382.464473189]: PR: parameters list received
[ INFO] [1517997385.266630692]: WP: item #0  F:0 C: 16 p: 0.000000 0.000000 0.000000 0.000000 x: 0.000000 y: 0.000000 z: 0.000000
[ INFO] [1517997385.266777025]: WP: mission received
[ WARN] [1517997385.877131952]: FCU: Low battery
[ INFO] [1517997390.217901655]: HP: requesting home position
[ INFO] [1517997400.217807588]: HP: requesting home position
[ INFO] [1517997410.217698396]: HP: requesting home position
[ INFO] [1517997420.217300107]: HP: requesting home position
[ INFO] [1517997430.218269151]: HP: requesting home position
[ INFO] [1517997440.217929423]: HP: requesting home position
[ INFO] [1517997450.217825988]: HP: requesting home position
[ INFO] [1517997460.217945641]: HP: requesting home position
[ INFO] [1517997470.217443402]: HP: requesting home position
[ INFO] [1517997480.218541883]: HP: requesting home position
[ INFO] [1517997490.217469710]: HP: requesting home position
[ INFO] [1517997500.217744682]: HP: requesting home position

Diagnostics

~/erle_ws$ rostopic echo -n1 /diagnostics
header: 
  seq: 250
  stamp: 
    secs: 1517997524
    nsecs: 852578434
  frame_id: ''
status: 
  - 
    level: 0
    name: mavros: FCU connection
    message: connected
    hardware_id: udp://10.0.0.2:6001@
    values: 
      - 
        key: Received packets:
        value: 908
      - 
        key: Dropped packets:
        value: 0
      - 
        key: Buffer overruns:
        value: 0
      - 
        key: Parse errors:
        value: 0
      - 
        key: Rx sequence number:
        value: 139
      - 
        key: Tx sequence number:
        value: 243
      - 
        key: Rx total bytes:
        value: 28404
      - 
        key: Tx total bytes:
        value: 6326
      - 
        key: Rx speed:
        value: 17.000000
      - 
        key: Tx speed:
        value: 122.000000
  - 
    level: 2
    name: mavros: GPS
    message: No satellites
    hardware_id: udp://10.0.0.2:6001@
    values: 
      - 
        key: Satellites visible
        value: 0
      - 
        key: Fix type
        value: 0
      - 
        key: EPH (m)
        value: Unknown
      - 
        key: EPV (m)
        value: Unknown
  - 
    level: 0
    name: mavros: Heartbeat
    message: Normal
    hardware_id: udp://10.0.0.2:6001@
    values: 
      - 
        key: Heartbeats since startup
        value: 96
      - 
        key: Frequency (Hz)
        value: 0.639991
      - 
        key: Vehicle type
        value: Quadrotor
      - 
        key: Autopilot type
        value: ArduPilotMega / ArduCopter
      - 
        key: Mode
        value: STABILIZE
      - 
        key: System status
        value: Critical
  - 
    level: 0
    name: mavros: System
    message: Normal
    hardware_id: udp://10.0.0.2:6001@
    values: 
      - 
        key: Sensor present
        value: 0x00000000
      - 
        key: Sensor enabled
        value: 0x00000000
      - 
        key: Sensor helth
        value: 0x00000000
      - 
        key: CPU Load (%)
        value: 0.0
      - 
        key: Drop rate (%)
        value: 0.0
      - 
        key: Errors comm
        value: 0
      - 
        key: Errors count #1
        value: 0
      - 
        key: Errors count #2
        value: 0
      - 
        key: Errors count #3
        value: 0
      - 
        key: Errors count #4
        value: 0
  - 
    level: 2
    name: mavros: Battery
    message: No data
    hardware_id: udp://10.0.0.2:6001@
    values: 
      - 
        key: Voltage
        value: -1.00
      - 
        key: Current
        value: 0.0
      - 
        key: Remaining
        value: 0.0
---

Check ID

rosrun mavros checkid
OK. I got messages from 1:1.
TSC21 commented 6 years ago

@khancyr maybe you can lend a hand?

mellonUAV commented 6 years ago

@TSC21 @khancyr Are these settings in the apm_config.yaml correct for what I am trying to do?

# setpoint_position
setpoint_position:
  tf:
    listen: false           # enable tf listener (disable topic subscribers)
    frame_id: "map"
    child_frame_id: "target_position"
    rate_limit: 50.0
  mav_frame: LOCAL_NED

Should I adjust any specific parameters for this task in APM?

Also here is my ros node that publishes to /setpoint_raw/global:

// code for sending target GPS position
#include <ros/ros.h>
#include <cstdlib>
#include <math.h>
#include <stdlib.h>
#include <stdio.h>
#include <mavros_msgs/GlobalPositionTarget.h>
#include <geometry_msgs/PoseStamped.h>

int main(int argc, char **argv) {

  ros::init(argc, argv, "setpoint_global");
  ros::NodeHandle n;

  ros::Publisher pub = n.advertise<mavros_msgs::GlobalPositionTarget>("setpoint_raw/global", 100);

  ros::Rate rate(10);

  while(ros::ok()){
    mavros_msgs::GlobalPositionTarget msg;

    msg.header.stamp=ros::Time::now();

    float longi = double(atoi(argv[1]));
    float lat = double(atoi(argv[2]));
    float alt = double(atoi(argv[3]));

    // msg.longitude = longi;
    // msg.latitude = lat;
    // msg.altitude = alt;

    msg.pose.position.y = longi;
    msg.pose.position.x = lat;
    msg.pose.position.z = alt;
    ROS_INFO("Position data sent %f, %f, %f", msg.pose.position.x, msg.pose.position.y, msg.pose.position.z);
    pub.publish(msg);
    // rc_override_pub.publish(msg_override);
    ros::spinOnce();
    rate.sleep();
    }
}
TSC21 commented 6 years ago

@mellonUAV is this still a problem?

TSC21 commented 6 years ago

@mellonUAV closing as stale. Please reopen if you still have problems with it.