You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

FreeFareTagBusiness.cpp 4.9KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160
  1. //
  2. // Created by robin on 7/22/16.
  3. //
  4. #include "FreeFareTagBusiness.h"
  5. FreeFareTagBusiness::FreeFareTagBusiness(std::shared_ptr<FreeFareTag> tag)
  6. : _tag(tag)
  7. {
  8. }
  9. ResultBool FreeFareTagBusiness::authenticate(int sector, int block, std::string key, int keyType)
  10. {
  11. return _tag->authenticate(sector, block, key, keyType);
  12. }
  13. ResultString FreeFareTagBusiness::readBlock(int sector, int block, std::string key, int keyType)
  14. {
  15. return _tag->readBlock(sector, block, key, keyType);
  16. }
  17. Result<SectorDbo> FreeFareTagBusiness::readSector(int sector, std::string key, int keyType)
  18. {
  19. std::string res;
  20. int lastBlock = _tag->getSectorBlockCount(sector);
  21. for (int i = 0; i < lastBlock; ++i) {
  22. auto data = readBlock(sector, i, key, keyType);
  23. if (data) {
  24. res += data.getData();
  25. }
  26. else {
  27. return Result<SectorDbo>::error(data);
  28. }
  29. }
  30. return Result<SectorDbo>::ok(SectorDbo(res));
  31. }
  32. const std::string &FreeFareTagBusiness::getUid() const
  33. {
  34. return _tag->getUid();
  35. }
  36. freefare_tag_type FreeFareTagBusiness::getType() const
  37. {
  38. return _tag->getType();
  39. }
  40. std::shared_ptr<FreeFareTag> FreeFareTagBusiness::getTag() const
  41. {
  42. return _tag;
  43. }
  44. Result<MappedKeys> FreeFareTagBusiness::mapKeys(std::vector<std::string> keys)
  45. {
  46. std::vector<std::vector<std::pair<std::string, std::string>>> mappedKeys;
  47. for (int i = 0; i < 16; ++i) {
  48. std::vector<std::pair<std::string, std::string>> sectorKeys;
  49. for (int j = 0; j < 4; ++j) {
  50. std::pair<std::string, std::string> blockKeys;
  51. for (auto key : keys) {
  52. if (authenticate(i, j, key, MFC_KEY_A)) {
  53. blockKeys.first = key;
  54. }
  55. if (authenticate(i, j, key, MFC_KEY_B)) {
  56. blockKeys.second = key;
  57. }
  58. if (!blockKeys.first.empty() && !blockKeys.second.empty()) {
  59. break;
  60. }
  61. }
  62. sectorKeys.push_back(blockKeys);
  63. }
  64. mappedKeys.push_back(sectorKeys);
  65. }
  66. return Result<std::vector<std::vector<std::pair<std::string, std::string>>>>::ok(mappedKeys);
  67. }
  68. Result<std::vector<SectorDbo>> FreeFareTagBusiness::dump(MappedKeys keys)
  69. {
  70. if (keys.size() != 16) {
  71. return Result<std::vector<SectorDbo>>::error("Must have 16 sectors");
  72. }
  73. for (int i = 0; i < keys.size(); ++i) {
  74. auto key = keys[i];
  75. if (key.size() != 4) {
  76. return Result<std::vector<SectorDbo>>::error("Must have 4 keys in sector " + i);
  77. }
  78. }
  79. std::vector<SectorDbo> sectors;
  80. for (int s = 0; s < keys.size(); ++s) {
  81. auto sectorKeys = keys[s];
  82. SectorDbo sector;
  83. bool keyA = false;
  84. bool keyB = false;
  85. for (int b = 0; b < sectorKeys.size() - 1; ++b) {
  86. auto blockKey = sectorKeys[b];
  87. std::string data = "";
  88. if (!blockKey.first.empty()) {
  89. auto blockResult = readBlock(s, b, blockKey.first, MFC_KEY_A);
  90. if (blockResult) {
  91. data = blockResult.getData();
  92. keyA = true;
  93. }
  94. }
  95. if (!blockKey.second.empty()) {
  96. auto blockResult = readBlock(s, b, blockKey.second, MFC_KEY_B);
  97. if (blockResult) {
  98. data = blockResult.getData();
  99. keyB = true;
  100. }
  101. }
  102. sector.setBlock(b, data);
  103. }
  104. int b = sectorKeys.size() - 1;
  105. auto blockKey = sectorKeys[b];
  106. std::string data = "";
  107. if (!blockKey.first.empty()) {
  108. auto blockResult = readBlock(s, b, blockKey.first, MFC_KEY_A);
  109. if (blockResult) {
  110. data = blockResult.getData();
  111. keyA = true;
  112. }
  113. }
  114. if (!blockKey.second.empty()) {
  115. auto blockResult = readBlock(s, b, blockKey.second, MFC_KEY_B);
  116. if (blockResult) {
  117. data = blockResult.getData();
  118. keyB = true;
  119. }
  120. }
  121. sector.setBlock(b, data);
  122. AccessBitsDbo accessBitsDbo = sector.getAccessBitsDbo();
  123. sector.setKeyA(keyA ? blockKey.first : "");
  124. sector.setKeyB(keyB ? blockKey.second : "");
  125. std::string accessBits;
  126. if (!data.empty())
  127. {
  128. if ((keyA && accessBitsDbo.canKeyAReadAccessBitsTrailer()) || (keyB && accessBitsDbo.canKeyBReadAccessBitsTrailer())) {
  129. accessBits = accessBitsDbo.getBits();
  130. }
  131. }
  132. sector.setAccessBits(accessBits);
  133. sectors.push_back(sector);
  134. }
  135. return Result<std::vector<SectorDbo>>::ok(sectors);
  136. }
  137. Result<std::vector<SectorDbo>> FreeFareTagBusiness::dump(std::vector<std::string> keys)
  138. {
  139. auto mappedKeysResult = mapKeys(keys);
  140. if (!mappedKeysResult) {
  141. return Result<std::vector<SectorDbo>>::error(mappedKeysResult);
  142. }
  143. return dump(mappedKeysResult.getData());
  144. }