Bart/bullet3
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Add body name when loading urdf.

Browse Source
This commit is contained in:
yunfeibai
2017-03-23 10:16:39 -07:00
parent 59fcf7ca24
commit 50f0cfca9e
7 changed files with 21 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
examples/Importers/ImportMJCFDemo/BulletMJCFImporter.cpp
View File

@@ -1311,6 +1311,11 @@ int BulletMJCFImporter::getRootLinkIndex() const
return "";
}
std::string BulletMJCFImporter::getBodyName() const
{
return m_data->m_fileModelName;
}
bool BulletMJCFImporter::getLinkColor(int linkIndex, btVector4& colorRGBA) const
{
// UrdfLink* link = m_data->getLink(linkIndex);

2
examples/Importers/ImportMJCFDemo/BulletMJCFImporter.h
View File

@@ -42,6 +42,8 @@ public:
///pure virtual interfaces, precondition is a valid linkIndex (you can assert/terminate if the linkIndex is out of range)
virtual std::string getLinkName(int linkIndex) const;
virtual std::string getBodyName() const;
/// optional method to provide the link color. return true if the color is available and copied into colorRGBA, return false otherwise
virtual bool getLinkColor(int linkIndex, btVector4& colorRGBA) const;

5
examples/Importers/ImportURDFDemo/BulletUrdfImporter.cpp
View File

@@ -270,6 +270,11 @@ std::string BulletURDFImporter::getLinkName(int linkIndex) const
return "";
}
std::string BulletURDFImporter::getBodyName() const
{
return m_data->m_urdfParser.getModel().m_name;
}
std::string BulletURDFImporter::getJointName(int linkIndex) const
{
UrdfLink* const* linkPtr = m_data->m_urdfParser.getModel().m_links.getAtIndex(linkIndex);

2
examples/Importers/ImportURDFDemo/BulletUrdfImporter.h
View File

@@ -35,6 +35,8 @@ public:
virtual void getLinkChildIndices(int linkIndex, btAlignedObjectArray<int>& childLinkIndices) const;
virtual std::string getBodyName() const;
virtual std::string getLinkName(int linkIndex) const;
virtual bool getLinkColor(int linkIndex, btVector4& colorRGBA) const;

3
examples/Importers/ImportURDFDemo/URDFImporterInterface.h
View File

@@ -27,6 +27,9 @@ public:
///pure virtual interfaces, precondition is a valid linkIndex (you can assert/terminate if the linkIndex is out of range)
virtual std::string getLinkName(int linkIndex) const =0;
virtual std::string getBodyName() const = 0;
/// optional method to provide the link color. return true if the color is available and copied into colorRGBA, return false otherwise
virtual bool getLinkColor(int linkIndex, btVector4& colorRGBA) const { return false;}

3
examples/SharedMemory/PhysicsServerCommandProcessor.cpp
View File

@@ -120,6 +120,7 @@ struct InteralBodyData
btMultiBody* m_multiBody;
btRigidBody* m_rigidBody;
int m_testData;
std::string m_bodyName;
btTransform m_rootLocalInertialFrame;
btAlignedObjectArray<btTransform> m_linkLocalInertialFrames;
@@ -1608,6 +1609,8 @@ bool PhysicsServerCommandProcessor::loadUrdf(const char* fileName, const btVecto
btMultiBody* mb = creation.getBulletMultiBody();
btRigidBody* rb = creation.getRigidBody();
bodyHandle->m_bodyName = u2b.getBodyName();
if (useMultiBody)
{