Skip to content

Instantly share code, notes, and snippets.

View davetcoleman's full-sized avatar

Dave Coleman davetcoleman

View GitHub Profile
@davetcoleman
davetcoleman / verticle_approach_test.cpp
Created November 20, 2014 07:01
Demo rosbag record code
/*********************************************************************
* Software License Agreement (BSD License)
*
* Copyright (c) 2013, University of Colorado, Boulder
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
bool getParameter(const std::string &param_name, std::string &value)
{
// Load a param
if (!nh.hasParam(param_name))
{
ROS_ERROR_STREAM_NAMED("shelf","Missing parameter '" << param_name << "'. Searching in namespace: " << nh.getNamespace());
return false;
}
nh.getParam("shelf_distance_from_baxter", value);
return true;
@davetcoleman
davetcoleman / vcs export --exact
Created March 27, 2015 18:07
vcs export --exact
repositories:
hrl_kinematics:
type: git
url: git@github.com:davetcoleman/hrl_kinematics.git
version: 4b97c35e0dbba688b1a58da57dd831b4e803ac1f
moveit_core:
type: git
url: git@bitbucket.org:davetcoleman/moveit_core.git
version: 04812a04c804db774cd6ccaad8d5ec3b8db2e1f1
moveit_hrp2:
#include <std_msgs/Bool.h>
// Initialize the ROS topic for recieving a stop command
std::size_t queue_size = 10;
stop_perception_sub_ = nh_.subscribe("/perception/stop_perception", queue_size, &Manipulator::stopPerceptionCallback, this);
void Manipulator::stopPerceptionCallback(const std_msgs::Bool::ConstPtr& msg)
{
// The robot has finished moving the camera around
Eigen::Affine3d RvizVisualTools::convertXYZRPY(std::vector<double> transform6)
{
if (transform6.size() != 6)
{
ROS_ERROR_STREAM_NAMED("rviz_visual_tools","Incorrect number of variables passed for 6-size transform");
throw;
}
// Eigen::AngleAxisd roll_angle (transform6[3], Eigen::Vector3d::UnitZ());
// Eigen::AngleAxisd pitch_angle(transform6[4], Eigen::Vector3d::UnitX());
std::string ik_tip_string = "tooltip0"; // TODO: make this a rosparam
ik_tip_link_ = robot_model_->getLinkModel(ik_tip_string);
- git:
local-name: geometric_shapes
uri: https://github.com/ros-planning/geometric_shapes.git
version: kinetic-devel
- git:
local-name: household_objects_database_msgs
uri: https://github.com/ros-interactive-manipulation/household_objects_database_msgs.git
version: hydro-devel
- git:
local-name: manipulation_msgs
[bloom] bloom version 0.5.21
[info] ROS Distro index file associate with commit 'dd92e570f3245209773543d31de658edc05a1c4e'
[info] New ROS Distro index url: 'https://raw.githubusercontent.com/ros/rosdistro/dd92e570f3245209773543d31de658edc05a1c4e/index.yaml'
[info] ==> Fetching 'rviz_visual_tools' repository from 'https://github.com/davetcoleman/rviz_visual_tools-release.git'
[debug] track_branches(bloom, None)
[debug] Tracking branches: []
[debug] Checking out to master
[debug] Requested checkout reference is the same as the current branch
[debug] /tmp/tmpDvaGkz:$ git ls-tree bloom
[debug] track_branches(['bloom', 'master'], None)
ros.moveit_ros_visualization: Waiting for MoveGroup action server (/recognize_objects)...
[Thread 0x7fffc1eb5700 (LWP 20353) exited]
rviz: /usr/include/boost/smart_ptr/shared_ptr.hpp:641: typename boost::detail::sp_dereference<T>::type boost::shared_ptr<T>::operator*() const [with T = const urdf::ModelInterface; typename boost::detail::sp_dereference<T>::type = const urdf::ModelInterface&]: Assertion `px != 0' failed.
Thread 18 "rviz" received signal SIGABRT, Aborted.
[Switching to Thread 0x7fffc26b6700 (LWP 20403)]
0x00007ffff69d7418 in __GI_raise (sig=sig@entry=6) at ../sysdeps/unix/sysv/linux/raise.c:54
54 ../sysdeps/unix/sysv/linux/raise.c: No such file or directory.
Errors << warehouse_ros_mongo:make /home/dave/ros/current/ws_moveit/logs/warehouse_ros_mongo/build.make.002.log
In file included from /home/dave/ros/current/ws_moveit/src/warehouse_ros_mongo/test/test_warehouse_ros_mongo.cpp:41:0:
/home/dave/ros/current/ws_moveit/src/warehouse_ros_mongo/test/test_mongo_helpers.h:53:8: error: ‘MongoMetadata’ does not name a type
inline MongoMetadata& downcastMetadata(Metadata::ConstPtr metadata) const {
^
/home/dave/ros/current/ws_moveit/src/warehouse_ros_mongo/test/test_mongo_helpers.h:57:8: error: ‘MongoQuery’ does not name a type
inline MongoQuery& downcastQuery(Query::ConstPtr query) const {
^
/home/dave/ros/current/ws_moveit/src/warehouse_ros_mongo/test/test_warehouse_ros_mongo.cpp: In member function ‘virtual void MongoRos_MongoRos_Test::TestBody()’:
/home/dave/ros/current/ws_moveit/src/warehouse_ros_mongo/test/test_warehouse_ros_mongo.cpp:81:61: error: no matching function for call to ‘warehouse_ros_mongo::MongoDatabaseConnection::openCollection(co