Skip to content

Instantly share code, notes, and snippets.

View simonschmeisser's full-sized avatar

Simon Schmeisser simonschmeisser

View GitHub Profile
@simonschmeisser
simonschmeisser / gist:cdde4dd59fb9d48cbf88dcbab780fd3d
Created July 13, 2016 08:31
fcl not finding octomap headers in DESTDIR
This file has been truncated, but you can view the full file.
sis@sisbox:~/ros_upstream2$ VERBOSE=1 LANG=c DESTDIR=$(pwd)/tmp catkin build -j4 -p1 -v
-------------------------------------------------------------------------------------------------
Profile: default
Extending: [env] /opt/ros/kinetic:/home/sis/Mikado/devel:/home/sis/ros_upstream/devel
Workspace: /home/sis/ros_upstream2
-------------------------------------------------------------------------------------------------
Source Space: [exists] /home/sis/ros_upstream2/src
Log Space: [exists] /home/sis/ros_upstream2/logs
Build Space: [exists] /home/sis/ros_upstream2/build
Devel Space: [exists] /home/sis/ros_upstream2/devel
@simonschmeisser
simonschmeisser / gist:956d9b167c644b46db6edde1ebfb160e
Created July 13, 2016 08:38
Added CPATH to help finding headers
This file has been truncated, but you can view the full file.
-------------------------------------------------------------------------------------------------
Profile: default
Extending: [env] /opt/ros/kinetic:/home/sis/Mikado/devel:/home/sis/ros_upstream/devel
Workspace: /home/sis/ros_upstream2
-------------------------------------------------------------------------------------------------
Source Space: [exists] /home/sis/ros_upstream2/src
Log Space: [exists] /home/sis/ros_upstream2/logs
Build Space: [exists] /home/sis/ros_upstream2/build
Devel Space: [exists] /home/sis/ros_upstream2/devel
Install Space: [exists] /opt/mikado-ros/
@simonschmeisser
simonschmeisser / gist:db78397f63825b2854bd4f1e3f20fad5
Created July 13, 2016 08:49
Adding LIBRARY_PATH works for fcl but not for collada_urdf
This file has been truncated, but you can view the full file.
-------------------------------------------------------------------------------------------------
Profile: default
Extending: [env] /opt/ros/kinetic:/home/sis/Mikado/devel:/home/sis/ros_upstream/devel
Workspace: /home/sis/ros_upstream2
-------------------------------------------------------------------------------------------------
Source Space: [exists] /home/sis/ros_upstream2/src
Log Space: [exists] /home/sis/ros_upstream2/logs
Build Space: [exists] /home/sis/ros_upstream2/build
Devel Space: [exists] /home/sis/ros_upstream2/devel
Install Space: [exists] /opt/mikado-ros/
- git:
local-name: fcl
uri: https://github.com/flexible-collision-library/fcl.git
version: 0.4.0
- git:
local-name: geometric_shapes
uri: https://github.com/ros-planning/geometric_shapes.git
- git:
local-name: graph_msgs
uri: https://github.com/davetcoleman/graph_msgs.git
@simonschmeisser
simonschmeisser / gist:c7f1d1be6591952d505fa05b307af982
Last active January 5, 2017 13:45
backtrace for TrajectoryExecution vs OctomapUpdater
Thread 9 (Thread 0x7fffc9ffb700 (LWP 14410)):
#0 pthread_cond_wait@@GLIBC_2.3.2 () at ../sysdeps/unix/sysv/linux/x86_64/pthread_cond_wait.S:185
No locals.
#1 0x00007ffff5fd79f3 in trajectory_execution_manager::TrajectoryExecutionManager::waitForExecution() () from /opt/ros/kinetic/lib/libmoveit_trajectory_execution_manager.so.0.9.3
No symbol table info available.
#2 0x000000000053984c in RosWorld::executePlan (this=0x1057730, plan=...) at /home/sis/Mikado/src/Yenga2/mikado_gui/src/RosWorld.cpp:558
status = {status_ = moveit_controller_manager::ExecutionStatus::UNKNOWN}
__PRETTY_FUNCTION__ = "moveit_controller_manager::ExecutionStatus RosWorld::executePlan(const moveit::planning_interface::MoveGroupInterface::Plan&)"
#3 0x000000000058eb83 in MoveTcpToTask::run (this=0x2dd4330) at /home/sis/Mikado/src/Yenga2/mikado_gui/src/tasks/MoveTcpToTask.cpp:116
result = <optimized out>
@simonschmeisser
simonschmeisser / gist:6f1c2e5d1cf91912478148a28cfcb814
Created January 6, 2017 15:47
new backtrace for "Crash when octomap is updated during TrajectoryExecution"
Thread 10 (Thread 0x7fffc97fa700 (LWP 27204)):
#0 0x00007ffff4f75c93 in octomap::OcTreeBaseImpl<octomap::OcTreeNode, octomap::AbstractOccupancyOcTree>::nodeChildExists (this=0x7fffb42c99e0, node=0x7fffa81b9870, childIdx=4) at /opt/ros/kinetic/include/octomap/OcTreeBaseImpl.hxx:237
No locals.
#1 octomap::OcTreeBaseImpl<octomap::OcTreeNode, octomap::AbstractOccupancyOcTree>::search (this=this@entry=0x7fffb42c99e0, key=..., depth=<optimized out>, depth@entry=0) at /opt/ros/kinetic/include/octomap/OcTreeBaseImpl.hxx:456
pos = 4
i = 15
key_at_depth = {k = {32674, 32360, 32802}}
curNode = 0x7fffa81b9870
#2 0x00007ffff4f7968f in octomap::OccupancyOcTreeBase<octomap::OcTreeNode>::updateNode (this=0x7fffb42c99e0, key=..., log_odds_update=-0.405465096, lazy_eval=<optimized out>) at /opt/ros/kinetic/include/octomap/OccupancyOcTreeBase.hxx:304
leaf = <optimized out>
Thread 74 (Thread 0x7ffefcff9700 (LWP 6788)):
#0 pthread_cond_timedwait@@GLIBC_2.3.2 () at ../sysdeps/unix/sysv/linux/x86_64/pthread_cond_timedwait.S:225
No locals.
#1 0x00007ffff5d68de0 in boost::condition_variable::do_wait_until (timeout=..., m=..., this=0x7fffb0f97bd0) at /usr/include/boost/thread/pthread/condition_variable.hpp:108
check_for_interruption = {thread_info = 0x7fffb0e5f160, m = 0x7fffb0f97bd0, set = true}
guard = {m = 0x7ffefcff8900}
cond_res = <optimized out>
#2 boost::condition_variable::wait_until (tp=..., lk=..., this=0x7fffb0f97bd0) at /usr/include/boost/thread/pthread/condition_variable_fwd.hpp:253
ts = {tv_sec = 1483718603, tv_nsec = 935101824}
Thread 10 (Thread 0x7fffc97fa700 (LWP 32751)):
#0 octomap::OcTreeBaseImpl<octomap::OcTreeNode, octomap::AbstractOccupancyOcTree>::nodeHasChildren (this=0x7fffb00ff8f0, node=<optimized out>) at /opt/ros/kinetic/include/octomap/OcTreeBaseImpl.hxx:249
No locals.
#1 octomap::OcTreeBaseImpl<octomap::OcTreeNode, octomap::AbstractOccupancyOcTree>::isNodeCollapsible (this=this@entry=0x7fffb00ff8f0, node=node@entry=0x7fffb4b9c8a0) at /opt/ros/kinetic/include/octomap/OcTreeBaseImpl.hxx:221
No locals.
#2 0x00007ffff4f68b2a in octomap::OcTreeBaseImpl<octomap::OcTreeNode, octomap::AbstractOccupancyOcTree>::pruneNode (this=0x7fffb00ff8f0, node=0x7fffb4b9c8a0) at /opt/ros/kinetic/include/octomap/OcTreeBaseImpl.hxx:269
No locals.
#3 0x00007ffff4f7940a in octomap::OccupancyOcTreeBase<octomap::OcTreeNode>::updateNodeRecurs (this=this@entry=0x7fffb00ff8f0, node=0x7fffb4b9c8a0, node_just_created=<optimized out>, key=..., depth=depth@entry=0, log_odds_update=@0x7fffc97f860c: -0.405465096, lazy_eval=false) at /opt/ros/kinetic/
@simonschmeisser
simonschmeisser / gist:71986a056ea6a6d6be2408ad4b846c84
Created November 7, 2018 14:08
Case1: lock_goal == True, JointTarget
[DEBUG] [1541599378.973538833]: STOMP Found no seed trajectory
[DEBUG] [1541599378.973601801]: STOMP Found goal from joint constraints
[DEBUG] [1541599378.975588566]: No cartesian constraints were found, failed validation
[DEBUG] [1541599378.975645497]: No cartesian constraints were found, failed validation
[DEBUG] [1541599379.171920211]: STOMP completed iteration 1 with cost 255,890387
[DEBUG] [1541599379.172004291]: Solution is no longer valid, resetting valid_iterations
[DEBUG] [1541599379.352017639]: STOMP completed iteration 2 with cost 255,503074
[DEBUG] [1541599379.352077281]: Solution is no longer valid, resetting valid_iterations
[DEBUG] [1541599379.550639466]: STOMP completed iteration 3 with cost 255,503074
[DEBUG] [1541599379.550696939]: Solution is no longer valid, resetting valid_iterations
stomp/manipulator:
group_name: manipulator
optimization:
num_timesteps: 100
num_iterations: 100
num_iterations_after_valid: 5
num_rollouts: 20
max_rollouts: 100
initialization_method: 1 #[1 : LINEAR_INTERPOLATION, 2 : CUBIC_POLYNOMIAL, 3 : MININUM_CONTROL_COST
control_cost_weight: 1.0