ConfigurerServoDrive.cpp 800 B

1234567891011121314151617181920212223242526272829
  1. #include "stdafx.h"
  2. #include "ConfigurerServoDrive.h"
  3. #include "ConfigurationManager.h"
  4. using namespace DIOS::Dev::Detail::MachineryECOM;
  5. int ConfigurerServoDrive::GetServoDriveNumber(const std::string &driveName)
  6. {
  7. auto configs = ConfigurationManager::Instance()->GetServoDriveConfig("ServoDrive");
  8. if (configs.GetFirstOf(driveName.c_str()) >= 0)
  9. {
  10. auto sec = configs[driveName.c_str()];
  11. return atoi(sec["DriveNumber"]);
  12. }
  13. return -1;
  14. }
  15. std::string ConfigurerServoDrive::GetServoDriveType(const std::string &driveName)
  16. {
  17. auto configs = ConfigurationManager::Instance()->GetServoDriveConfig("ServoDrive");
  18. if (configs.GetFirstOf(driveName.c_str()) >= 0)
  19. {
  20. auto sec = configs[driveName.c_str()];
  21. return (const char *)sec["DriveType"];
  22. }
  23. return "";
  24. }