-
Notifications
You must be signed in to change notification settings - Fork 30
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
Merging changes from the Summer 2019 ADA Demo #542
Conversation
…ique, put preprocessor directives around deprecated DART functions.
@@ -1,6 +1,7 @@ | |||
#ifndef AIKIDO_CONSTRAINT_FINITESAMPLEABLE_HPP_ | |||
#define AIKIDO_CONSTRAINT_FINITESAMPLEABLE_HPP_ | |||
|
|||
#include "aikido/statespace/dart/MetaSkeletonStateSpace.hpp" |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
I don't think these change are right? They might also be duplicated from #529.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Yeah, my mistake, let me roll back the master merge and re-do it.
ec642f4
to
e2c97c2
Compare
Didn't we just add |
@brianhou Yep, just noticed that, so I'm re-merging the change into this branch. |
@brianhou Ok, ready for comment now I think. |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Thanks for making these changes!
Minor thought: does it make sense to also replace ::aikido
with aikido
? I don't see a need for the former.
{ | ||
// CollisionFreeOutcome* collisionFreeOutcome |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Should this just be deleted?
@@ -35,15 +35,22 @@ statespace::ConstStateSpacePtr CollisionFree::getStateSpace() const | |||
//============================================================================== | |||
bool CollisionFree::isSatisfied( | |||
const aikido::statespace::StateSpace::State* _state, | |||
TestableOutcome* outcome) const | |||
__attribute__((unused)) TestableOutcome* outcome) const |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Should this just be deleted (or at least the parameter name, if we're not using it)?
@@ -65,6 +72,7 @@ bool CollisionFree::isSatisfied( | |||
{ | |||
collisionFreeOutcome->mPairwiseContacts = collisionResult.getContacts(); | |||
} | |||
std::cout << collisionFreeOutcome->toString() << std::endl; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Is this for debugging?
@@ -220,7 +220,8 @@ bool IkSampleGenerator::sample(statespace::StateSpace::State* _state) | |||
|
|||
mInverseKinematics->getTarget()->setTransform(poseState.getIsometry()); | |||
|
|||
// Run the IK solver. If an exact solution is computed, apply it to the skeleton. | |||
// Run the IK solver. If an exact solution is computed, apply it to the |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Can we move this comment inside the #if
? Would that help the formatter put it at the right indentation level?
@@ -139,6 +139,7 @@ void KinematicSimulationTrajectoryExecutor::step( | |||
// Check if trajectory has completed. | |||
if (executionTime >= mTraj->getEndTime()) | |||
{ | |||
std::cout << "Trajectory completed" << std::endl; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Remove?
@@ -151,52 +155,60 @@ UniqueInterpolatedPtr concatenate( | |||
//============================================================================== | |||
double findTimeOfClosestStateOnTrajectory( |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Hmm, should this function remain in aikido::trajectory
or would it make sense to have it in aikido::distance
instead?
@@ -9,6 +9,7 @@ add_library("${PROJECT_NAME}_trajectory" SHARED ${sources}) | |||
target_link_libraries("${PROJECT_NAME}_trajectory" | |||
PUBLIC | |||
"${PROJECT_NAME}_common" | |||
"${PROJECT_NAME}_distance" |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
If we keep this dependency, we should make sure to update the comments of src/CMakeLists.txt
too.
return findTime; | ||
} | ||
|
||
//============================================================================== | ||
UniqueSplinePtr createPartialTrajectory( | ||
const Spline& traj, double partialStartTime) | ||
{ | ||
std::cout << "traj starts at " << traj.getStartTime() << " ends at " |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Delete?
if (partialStartTime < traj.getStartTime() | ||
|| partialStartTime > traj.getEndTime()) | ||
{ | ||
throw std::runtime_error("Wrong partial start time"); | ||
dtwarn << "Wrong partial start time" << std::endl; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Why warn instead of error?
@@ -254,6 +266,8 @@ UniqueSplinePtr createPartialTrajectory( | |||
traj.getSegmentStartState(i)); | |||
} | |||
|
|||
std::cout << "outputTrajectory starts at " << outputTrajectory->getStartTime() |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Delete?
Rendered out-dated by #543 |
Remove GCC7 / Ubuntu 18.04 compiler warnings, fixed NominalConfigurationRanker for ADA.
Tested on ADA directly, plus simulator tested via the feeding demo.
@gilwoolee Did you run any other tests?
Before creating a pull request
make format
Before merging a pull request
CHANGELOG.md