SUMMARY
========

PARAMETERS
 * /crazyflie/anchor0_pos: [0, 0, 0.6]
 * /crazyflie/anchor1_pos: [0, 0, 2]
 * /crazyflie/anchor2_pos: [3.1, 0, 0.6]
 * /crazyflie/anchor3_pos: [3.1, 2.35, 0.6]
 * /crazyflie/anchor4_pos: [2.48, 2.35, 1.72]
 * /crazyflie/anchor5_pos: [0.17, 2.35, 1.72]
 * /crazyflie/crazyflie_add/genericLogTopicFrequencies: [30, 30, 30]
 * /crazyflie/crazyflie_add/genericLogTopic_log_kfpos_Variables: ['kalman.stateX',...
 * /crazyflie/crazyflie_add/genericLogTopic_log_kfqt_Variables: ['kalman.q0', 'ka...
 * /crazyflie/crazyflie_add/genericLogTopic_log_ranges_Variables: ['ranging.distanc...
 * /crazyflie/crazyflie_add/genericLogTopics: ['log_kfpos', 'lo...
 * /crazyflie/crazyflie_add/tf_prefix: crazyflie
 * /crazyflie/crazyflie_add/uri: radio://0/80/250K
 * /crazyflie/joy/dev: /dev/input/js0
 * /crazyflie/joystick_controller/use_crazyflie_controller: True
 * /crazyflie/n_anchors: 6
 * /crazyflie/pose/name: goal
 * /crazyflie/pose/rate: 30
 * /crazyflie/pose/x: 1.3
 * /crazyflie/pose/y: 1.0
 * /crazyflie/pose/z: 1.0
 * /robot_description: <?xml version="1....
 * /rosdistro: kinetic
 * /rosversion: 1.12.7

NODES
  /crazyflie/
    controller_bridge (bitcraze_lps_estimator/crazyflie_controller_bridge.py)
    crazyflie_add (crazyflie_driver/crazyflie_add)
    joy (joy/joy_node)
    joystick_controller (crazyflie_demo/controller.py)
    log_range (bitcraze_lps_estimator/log_range.py)
    lps_efk_bridge (bitcraze_lps_estimator/lps_ekf_bridge.py)
    lps_viz (bitcraze_lps_estimator/lps_viz.py)
    pose (crazyflie_demo/publish_pose_teleop.py)
  /
    crazyflie_server (crazyflie_driver/crazyflie_server)
    link1_broadcaster (tf/static_transform_publisher)
    rviz (rviz/rviz)

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

setting /run_id to dab5b4de-1fb0-11e7-b2ae-080027acc4c9
process[rosout-1]: started with pid [17162]
started core service [/rosout]
process[rviz-2]: started with pid [17165]
process[crazyflie/crazyflie_add-3]: started with pid [17166]
process[crazyflie/joy-4]: started with pid [17167]
process[crazyflie/joystick_controller-5]: started with pid [17188]
process[crazyflie/controller_bridge-6]: started with pid [17201]
process[crazyflie/pose-7]: started with pid [17205]
process[crazyflie/lps_efk_bridge-8]: started with pid [17216]
[ INFO] [1492023012.059449192]: wait_for_service /add_crazyflie
[ INFO] [1492023012.070772705]: waitForService: Service [/add_crazyflie] has not been advertised, waiting...
/home/geco/catkin_ws/src/crazyflie_ros/crazyflie_demo/scripts/publish_pose_teleop.py:46: SyntaxWarning: name 'lastData' is assigned to before global declaration
  global lastData
[ INFO] [1492023012.085339224]: Opened joystick: /dev/input/js0. deadzone_: 0.050000.
process[crazyflie/lps_viz-9]: started with pid [17224]
process[crazyflie/log_range-10]: started with pid [17229]
process[link1_broadcaster-11]: started with pid [17232]
process[crazyflie_server-12]: started with pid [17237]
[ INFO] [1492023012.459223360]: waitForService: Service [/add_crazyflie] is now available.
[ INFO] [1492023012.459327739]: found /add_crazyflie
[ INFO] [1492023012.542091731]: Adding radio://0/80/250K as crazyflie with trim(0.000000, 0.000000). Logging: 1, Parameters: 1, Use ROS time: 1
Configured Dongle with version 0.53
[crazyflie/crazyflie_add-3] process has finished cleanly
log file: /home/geco/.ros/log/dab5b4de-1fb0-11e7-b2ae-080027acc4c9/crazyflie-crazyflie_add-3*.log
Receive LIBUSB_ERROR_TIMEOUT
Receive LIBUSB_ERROR_TIMEOUT
SYS: -------------------------
---

unning!

SYS: Build 258:ffefd74d9b9a (2
016.09-258) CLEAN

SYS: I am 0x313438353133470327
0025 and I have 1024KB of flas
h!

AK8963 I2C connection [OK].

LPS25H I2C connection [OK].

DECK_DRIVERS: Found 9 drivers

DECK_INFO: Found 1 deck memory
.

DECK_CORE: 1 deck enumerated

MPU6500: Self test gyro X [FAI
asured: -20.73

SYS: Free heap: 6080 bytes

[ INFO] [1492023015.315288071]: Requesting parameters...
Params: 126
[ WARN] [1492023015.757679257]: Link Quality low (0.570000)
[ WARN] [1492023016.020793765]: Link Quality low (0.470000)
[ WARN] [1492023016.222270216]: Link Quality low (0.670000)
[ INFO] [1492023016.921750217]: Requesting Logging variables...
[INFO] [1492023016.925348]: Setting anchor position ...
Log: 154
[INFO] [1492023016.937436]: Anchor 0 at [0, 0, 0.6]
[ INFO] [1492023016.973959731]: Update parameters
[INFO] [1492023017.022022]: Anchor 1 at [0, 0, 2]
[ INFO] [1492023017.035112508]: Update parameters
[INFO] [1492023017.097276]: found update_params service
[INFO] [1492023017.098329]: waiting for emergency service
[INFO] [1492023017.102638]: Anchor 2 at [3.1, 0, 0.6]
[INFO] [1492023017.110001]: found emergency service
[INFO] [1492023017.113934]: waiting for land service
[ INFO] [1492023017.120020786]: Update parameters
[INFO] [1492023017.122533]: found land service
[INFO] [1492023017.123086]: waiting for takeoff service
[INFO] [1492023017.132364]: found takeoff service
[INFO] [1492023017.179774]: Anchor 3 at [3.1, 2.35, 0.6]
[ INFO] [1492023017.198552884]: Update parameters
[INFO] [1492023017.282617]: Anchor 4 at [2.48, 2.35, 1.72]
[ INFO] [1492023017.294439152]: Update parameters
[INFO] [1492023017.382676]: Anchor 5 at [0.17, 2.35, 1.72]
[ INFO] [1492023017.400973777]: Update parameters
[ INFO] [1492023017.461389479]: Update parameters
[ INFO] [1492023017.933696398]: Ready...
[ INFO] [1492023017.933845147]: Elapsed: 2.618578 s
[ WARN] [1492023017.971416171]: Link Quality low (0.630000)
[ WARN] [1492023018.303011176]: Link Quality low (0.480000)
[ WARN] [1492023018.687157406]: Link Quality low (0.480000)
[ WARN] [1492023019.055293258]: Link Quality low (0.500000)