Instead of going through the map twice, you could do
std::map<whatever>::const_iterator stageDataIt = pGroup->m_approach.find(stage);
if (stageDataIt != pGroup->m_approach.end()) {
  const matrix4x4f &mt = *stageDataIt;
  ...
}