Skip to content

Instantly share code, notes, and snippets.

@simonschmeisser
Created November 1, 2021 10:43
Show Gist options
  • Save simonschmeisser/e18c7cb98dd2f8a525c69b2b98dd9005 to your computer and use it in GitHub Desktop.
Save simonschmeisser/e18c7cb98dd2f8a525c69b2b98dd9005 to your computer and use it in GitHub Desktop.
trajopt example run
roslaunch moveit_tutorials trajopt_example_launch.launch
... logging to /home/sis/mikado/logs/a80e3f82-3aff-11ec-8553-6d17cb1a77ac/roslaunch-sisPad2-23484.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
started roslaunch server http://sisPad2:33497/
SUMMARY
========
PARAMETERS
* /rosdistro: noetic
* /rosversion: 1.15.13
* /trajopt_example/joint_pos_term_info/goal_pos/first_timestep: 49
* /trajopt_example/joint_pos_term_info/goal_pos/last_timestep: 49
* /trajopt_example/joint_pos_term_info/goal_pos/name: goal_pos
* /trajopt_example/joint_pos_term_info/goal_pos/term_type: 2
* /trajopt_example/joint_pos_term_info/goal_tmp/first_timestep: 19
* /trajopt_example/joint_pos_term_info/goal_tmp/last_timestep: 19
* /trajopt_example/joint_pos_term_info/goal_tmp/name: goal_tmp
* /trajopt_example/joint_pos_term_info/goal_tmp/term_type: 2
* /trajopt_example/joint_pos_term_info/middle_pos/first_timestep: 10
* /trajopt_example/joint_pos_term_info/middle_pos/last_timestep: 10
* /trajopt_example/joint_pos_term_info/middle_pos/name: middle_pos
* /trajopt_example/joint_pos_term_info/middle_pos/term_type: 2
* /trajopt_example/joint_pos_term_info/start_pos/first_timestep: 0
* /trajopt_example/joint_pos_term_info/start_pos/last_timestep: 0
* /trajopt_example/joint_pos_term_info/start_pos/name: start_pos
* /trajopt_example/joint_pos_term_info/start_pos/term_type: 2
* /trajopt_example/problem_info/basic_info/convex_solver: 1
* /trajopt_example/problem_info/basic_info/dt_lower_lim: 100.0
* /trajopt_example/problem_info/basic_info/dt_upper_lim: 2.0
* /trajopt_example/problem_info/basic_info/n_steps: 50
* /trajopt_example/problem_info/basic_info/start_fixed: False
* /trajopt_example/problem_info/basic_info/use_time: False
* /trajopt_example/problem_info/init_info/dt: 0.1
* /trajopt_example/problem_info/init_info/type: 1
* /trajopt_example/trajopt_param/cnt_tolerance: 1e-3
* /trajopt_example/trajopt_param/improve_ratio_threshold: 0.005
* /trajopt_example/trajopt_param/max_iter: 100
* /trajopt_example/trajopt_param/max_merit_coeff_increases: 5
* /trajopt_example/trajopt_param/max_time: inf
* /trajopt_example/trajopt_param/merit_coeff_increase_ratio: 10
* /trajopt_example/trajopt_param/merit_error_coeff: 10
* /trajopt_example/trajopt_param/min_approx_improve: 1e-4
* /trajopt_example/trajopt_param/min_approx_improve_frac: -inf
* /trajopt_example/trajopt_param/min_trust_box_size: 1e-4
* /trajopt_example/trajopt_param/trust_box_size: 1e-1
* /trajopt_example/trajopt_param/trust_expand_ratio: 5
* /trajopt_example/trajopt_param/trust_shrink_ratio: 0.01
NODES
/
trajopt_example (moveit_tutorials/trajopt_example)
ROS_MASTER_URI=http://localhost:11311
process[trajopt_example-1]: started with pid [23498]
[ INFO] [1635763134.359033059]: Loading robot model 'panda'...
[ WARN] [1635763134.361046178]: Link panda_leftfinger has visual geometry but no collision geometry. Collision geometry will be left empty. Fix your URDF file by explicitly specifying collision geometry.
[ WARN] [1635763134.361105097]: Link panda_rightfinger has visual geometry but no collision geometry. Collision geometry will be left empty. Fix your URDF file by explicitly specifying collision geometry.
[ INFO] [1635763134.461380240]: Starting planning scene monitor
[ INFO] [1635763134.462600499]: Listening to '/planning_scene'
[ INFO] [1635763134.462646483]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1635763134.463698171]: Listening to '/collision_object'
[ INFO] [1635763134.466495495]: Listening to '/planning_scene_world' for planning scene world geometry
[ WARN] [1635763134.467448050]: Resolution not specified for Octomap. Assuming resolution = 0.1 instead
[ WARN] [1635763134.467498574]: Target frame "world" specified but no TF instance (buffer) specified. No transforms will be applied to received data.
[ INFO] [1635763134.467876009]: No 3D sensor plugin(s) defined for octomap updates
[ INFO] [1635763134.476946612]: Listening to '/attached_collision_object' for attached collision objects
[ INFO] [1635763134.488809260]: end effector name panda_link8
joint names: panda_joint1 panda_joint2 panda_joint3 panda_joint4 panda_joint5 panda_joint6 panda_joint7
You can set logging level with TRAJOPT_LOG_THRESH. Valid values: FATAL ERROR WARN INFO DEBUG TRACE. Defaulting to ERROR
[ INFO] [1635763134.495285262]: ======================================= initialize gets called
[ INFO] [1635763134.495314326]: ======================================= group name: hand, robot model: panda
[ INFO] [1635763134.495354920]: TrajOptPlanningContext is constructed
[ INFO] [1635763134.495381509]: TrajOptInterface is constructed
[ INFO] [1635763134.495406496]: ======================================= group name: panda_arm, robot model: panda
[ INFO] [1635763134.495416724]: TrajOptPlanningContext is constructed
[ INFO] [1635763134.495429668]: TrajOptInterface is constructed
[ INFO] [1635763134.495442161]: ======================================= group name: panda_arm_hand, robot model: panda
[ INFO] [1635763134.495452490]: TrajOptPlanningContext is constructed
[ INFO] [1635763134.495465845]: TrajOptInterface is constructed
[ INFO] [1635763134.495482075]: Using planning interface 'TrajOpt'
[ INFO] [1635763134.497824731]: ======================================= joint position at goal: 1.19428
[ INFO] [1635763134.497870345]: ======================================= joint position at goal: -0.107883
[ INFO] [1635763134.497888278]: ======================================= joint position at goal: -0.398759
[ INFO] [1635763134.497902885]: ======================================= joint position at goal: -2.27507
[ INFO] [1635763134.497918695]: ======================================= joint position at goal: -0.18253
[ INFO] [1635763134.497941046]: ======================================= joint position at goal: 2.64035
[ INFO] [1635763134.497958047]: ======================================= joint position at goal: -1.37274
[ WARN] [1635763134.999184939]: Topic '/display_robot_state' unable to connect to any subscribers within 0.5 sec. It is possible initially published visual messages will be lost.
[ INFO] [1635763135.225971891]: RemoteControl Ready.
Waiting to continue: Press 'next' in the RvizVisualToolsGui window to start the demo... continuing
Waiting to continue: Press 'next' to see the collision object
... continuing
[ WARN] [1635763171.255028208]: The complete state of the robot is not yet known. Missing virtual_joint
Waiting to continue: Press 'next' do the planning
[ WARN] [1635763171.255392721]: Empty quaternion found in pose message. Setting to neutral orientation.
... continuing
[ INFO] [1635763184.762480493]: ======================================= getPlanningContext() is called
[ INFO] [1635763184.762548709]: ======================================= collision detector is set to Bullet
[ INFO] [1635763184.770554150]: ======================================= context is made
[ INFO] [1635763184.770725256]: The timeout for planning must be positive (0.000000 specified). Assuming one second instead.
[ INFO] [1635763184.770885962]: solve is called
[ INFO] [1635763184.782616306]: Extract current state information
===>>> from interface upper:): 0 -0.785 0 -2.356 0 1.571 0.785
[ INFO] [1635763184.782795998]: ======================================= Extract start state infromation
[ INFO] [1635763184.782869574]: joint position from start state, name: panda_joint1, value: 1.184915
[ INFO] [1635763184.782890562]: joint position from start state, name: panda_joint2, value: -1.636251
[ INFO] [1635763184.782913044]: joint position from start state, name: panda_joint3, value: -1.454372
[ INFO] [1635763184.782931077]: joint position from start state, name: panda_joint4, value: -1.853625
[ INFO] [1635763184.782951274]: joint position from start state, name: panda_joint5, value: -1.863911
[ INFO] [1635763184.782967985]: joint position from start state, name: panda_joint6, value: 1.662081
[ INFO] [1635763184.782983945]: joint position from start state, name: panda_joint7, value: 0.797858
[ INFO] [1635763184.783033135]: ======================================= Create ProblemInfo
[ INFO] [1635763184.786017452]: ======================================= Populate init info
[ INFO] [1635763184.786114812]: ======================================= Create Constraints
[ INFO] [1635763184.786132725]: ======================================= Cartesian Constraints
[ INFO] [1635763184.786196372]: ======================================= Constraints from request goal_constraints
[ INFO] [1635763184.787961369]: Goal joint position is: 1.19428
[ INFO] [1635763184.788009247]: Goal joint position is: -0.107883
[ INFO] [1635763184.788026669]: Goal joint position is: -0.398759
[ INFO] [1635763184.788048770]: Goal joint position is: -2.27507
[ INFO] [1635763184.788064429]: Goal joint position is: -0.18253
[ INFO] [1635763184.788079126]: Goal joint position is: 2.64035
[ INFO] [1635763184.788096077]: Goal joint position is: -1.37274
[ INFO] [1635763184.788145889]: ======================================= Constraints from request start_state
[ INFO] [1635763184.789039107]: ======================================= Velocity Cost, hard-coded
[ INFO] [1635763184.789061078]: ======================================= Velocity Constraint, hard-coded
[ INFO] [1635763184.789079282]: ======================================= Collision Cost, hard-coded
[ INFO] [1635763184.789109808]: ======================================= Visibility Constraints
[ INFO] [1635763184.789154240]: ======================================= Construct problem
[ INFO] [1635763184.789302564]: ======================================= problem_description: limits
[ INFO] [1635763184.789326047]: joint 0 with lower bound: -2.897300, upper bound: 2.897300
[ INFO] [1635763184.789344260]: joint 1 with lower bound: -1.762800, upper bound: 1.762800
[ INFO] [1635763184.789360601]: joint 2 with lower bound: -2.897300, upper bound: 2.897300
[ INFO] [1635763184.789377672]: joint 3 with lower bound: -3.071800, upper bound: -0.069800
[ INFO] [1635763184.789394203]: joint 4 with lower bound: -2.897300, upper bound: 2.897300
[ INFO] [1635763184.789411074]: joint 5 with lower bound: -0.017500, upper bound: 3.752500
[ INFO] [1635763184.789426733]: joint 6 with lower bound: -2.897300, upper bound: 2.897300
[ INFO] [1635763184.790398486]: problem description: the name of the cost: joint_velocity
[ INFO] [1635763184.790811929]: problem description: the name of the cost: collision
[ INFO] [1635763184.982347970]: problem description:: the name of the constraint: goal_pos
[ INFO] [1635763184.982699478]: problem description:: the name of the constraint: start_pos
[ INFO] [1635763184.982856999]: num_cost 50
[ INFO] [1635763184.982876104]: num_constraints 2
[ INFO] [1635763184.982885582]: ======================================= TrajOpt Optimization
[ INFO] [1635763184.984203814]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984242876]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984342079]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984372335]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984458003]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984474924]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984557697]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984582422]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984676476]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984690672]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984783594]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984803130]: Contact between: box1 and panda_link1
[ INFO] [1635763184.984874141]: Contact between: box1 and panda_link0
[ INFO] [1635763184.984907041]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985026963]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985049284]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985137026]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985147235]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985218757]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985227863]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985316858]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985338067]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985434966]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985447138]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985527266]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985536403]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985616340]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985632961]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985704363]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985713590]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985781916]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985790792]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985857545]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985866943]: Contact between: box1 and panda_link1
[ INFO] [1635763184.985938545]: Contact between: box1 and panda_link0
[ INFO] [1635763184.985947962]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986009926]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986019604]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986098259]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986115832]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986188506]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986197693]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986268974]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986277761]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986348301]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986357207]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986421816]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986430903]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986498628]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986508276]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986576943]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986585749]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986650839]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986659886]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986725978]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986734984]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986803040]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986811766]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986876796]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986885302]: Contact between: box1 and panda_link1
[ INFO] [1635763184.986951223]: Contact between: box1 and panda_link0
[ INFO] [1635763184.986960370]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987025040]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987033966]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987105278]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987114665]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987181288]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987190114]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987256406]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987265122]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987330072]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987338568]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987404079]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987413356]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987480290]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987489026]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987554256]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987562712]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987628633]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987637319]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987704153]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987713039]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987776897]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987786034]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987854179]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987862685]: Contact between: box1 and panda_link1
[ INFO] [1635763184.987928476]: Contact between: box1 and panda_link0
[ INFO] [1635763184.987956909]: Contact between: box1 and panda_link1
[ INFO] [1635763184.988026818]: Contact between: box1 and panda_link0
[ INFO] [1635763184.988036055]: Contact between: box1 and panda_link1
[ INFO] [1635763184.988117936]: Contact between: box1 and panda_link0
[ INFO] [1635763184.988142742]: Contact between: box1 and panda_link1
[ INFO] [1635763184.988248687]: Contact between: box1 and panda_link0
[ INFO] [1635763184.988263745]: Contact between: box1 and panda_link1
[ INFO] [1635763184.988338834]: Contact between: box1 and panda_link0
[ INFO] [1635763184.988348802]: Contact between: box1 and panda_link1
[ INFO] [1635763184.988416697]: Contact between: box1 and panda_link0
[ INFO] [1635763184.988426255]: Contact between: box1 and panda_link1
[ERROR] [1635763184.988516011]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988534344]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988552678]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988561484]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988609182]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988618440]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988628899]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988637334]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988659495]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988668512]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988679232]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988687106]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988704448]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988713024]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988723403]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988730957]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988748490]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988757296]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988767575]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988776211]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988794484]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988803200]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988813249]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988822186]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988842032]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988850858]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988860767]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988869112]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988888548]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988897444]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988907433]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988914947]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988934272]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988942487]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988952266]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988960731]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988986569]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.988995355]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989005364]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989014430]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989032604]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989041480]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989051509]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989060295]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989078248]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989086844]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989096792]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989106109]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989123992]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989132117]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989142336]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989150461]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989172352]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989181408]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989191607]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989200494]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989219108]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989227954]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989237943]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989246298]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989265544]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989274300]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989284288]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989292934]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989310827]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989319533]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989329922]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989338358]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989356832]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989365538]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989374765]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989382600]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989400833]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989409209]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989419077]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989427783]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989445225]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989454101]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989464581]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989472305]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989491531]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989500187]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989510746]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989519412]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989545911]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989554727]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989564966]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989573392]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989592747]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989601453]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989612894]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989621080]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989642900]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989651406]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989661504]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989669269]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989687141]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989696228]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989706818]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989714342]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989734439]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989743105]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989753564]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989761599]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989782668]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989791224]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989800611]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989809587]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989828232]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989837158]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989845864]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989854290]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989872544]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989881640]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989891479]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989900565]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989917386]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989926303]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989937343]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989946019]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989968951]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989977658]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989987926]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.989996302]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990013584]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990022059]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990032088]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990039792]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990059118]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990067704]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990078454]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990086899]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990106054]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990114410]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990125210]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990132994]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990154273]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990163601]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990174711]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990183137]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990201180]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990209435]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990218572]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990227729]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990245081]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990292468]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990302888]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990312215]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990333915]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990342010]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990353932]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990365864]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990396090]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990407390]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990423821]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990431735]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990459236]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990467682]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990477901]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990488871]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990512895]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990521050]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990530668]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990541788]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990570431]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990584257]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990595137]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990602621]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990621005]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990630031]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990640471]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990648806]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990666739]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990675165]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990685363]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990693949]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990715499]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990722943]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990733853]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990741267]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990759821]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990768026]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990778856]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990786199]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990803141]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990811696]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990821505]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990830671]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990846591]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990854936]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990865305]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990873671]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990893007]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990901212]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990912082]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
[ERROR] [1635763184.990921038]: Link name 'panda_link0' does not exist in the chain 'panda_arm' or is not a child for this chain
ERROR in LDL_factor: Error in KKT matrix LDL factorization when computing the nonzero elements. The problem seems to be non-convex
ERROR in osqp_setup: Linear systems solver initialization failure
ERROR in osqp_solve: Workspace not initialized
[ERROR] convex solver failed! set TRAJOPT_LOG_THRESH=DEBUG to see solver output. saving model to /tmp/fail.lp and IIS to /tmp/fail.ilp
[ INFO] [1635763184.994442856]: ======================================= TrajOpt Solution
[ INFO] [1635763184.994493590]: num_rows 50
[ INFO] [1635763184.994503168]: num_cols 7
[ INFO] [1635763184.994528194]: ======================================= check if final state is within goal tolerances
[ INFO] [1635763184.994552649]: joint_value response: 0 goal: 1.19428
[ INFO] [1635763184.994562778]: joint_value response: -0.785 goal: -0.107883
[ INFO] [1635763184.994572045]: joint_value response: 0 goal: -0.398759
[ INFO] [1635763184.994581252]: joint_value response: -2.356 goal: -2.27507
[ INFO] [1635763184.994590298]: joint_value response: 0 goal: -0.18253
[ INFO] [1635763184.994598534]: joint_value response: 1.571 goal: 2.64035
[ INFO] [1635763184.994607179]: joint_value response: 0.785 goal: -1.37274
[ INFO] [1635763184.994628399]: index 0: jc.configure(constraint)=> 1, jc.decide(last_state).satisfied=> 1, tolerance 0.001000
[ERROR] [1635763184.994638317]: Goal constraints are violated: panda_joint1
[ERROR] [1635763184.994676077]: Could not compute plan successfully
[ INFO] [1635763185.006884463]: Stopping world geometry monitor
[ INFO] [1635763185.008165136]: Stopping planning scene monitor
[trajopt_example-1] process has finished cleanly
log file: /home/sis/mikado/logs/a80e3f82-3aff-11ec-8553-6d17cb1a77ac/trajopt_example-1*.log
all processes on machine have died, roslaunch will exit
shutting down processing monitor...
... shutting down processing monitor complete
done
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment