Implement 'getMode'

This commit is contained in:
jacobperron 2016-03-28 22:31:23 -07:00
parent 75dd293bfd
commit fbef2e2c88
3 changed files with 14 additions and 3 deletions

View file

@ -687,6 +687,16 @@ namespace create {
}
}
create::CreateMode Create::getMode() const {
if (data->isValidPacketID(ID_OI_MODE)) {
return (create::CreateMode) GET_DATA(ID_OI_MODE);
}
else {
CERR("[create::Create] ", "Querying Mode not supported!");
return create::MODE_UNAVAILABLE;
}
}
const Pose& Create::getPose() const {
return pose;
}