ClassFlowCNNGeneral.cpp 41 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983
  1. #include "ClassFlowCNNGeneral.h"
  2. #include <math.h>
  3. #include <iomanip>
  4. #include <sys/types.h>
  5. #include <sstream> // std::stringstream
  6. #include "CTfLiteClass.h"
  7. #include "ClassLogFile.h"
  8. #include "esp_log.h"
  9. #include "../../include/defines.h"
  10. static const char* TAG = "CNN";
  11. //#ifdef CONFIG_HEAP_TRACING_STANDALONE
  12. #ifdef HEAP_TRACING_CLASS_FLOW_CNN_GENERAL_DO_ALING_AND_CUT
  13. #include <esp_heap_trace.h>
  14. #define NUM_RECORDS 300
  15. static heap_trace_record_t trace_record[NUM_RECORDS]; // This buffer must be in internal RAM
  16. #endif
  17. ClassFlowCNNGeneral::ClassFlowCNNGeneral(ClassFlowAlignment *_flowalign, t_CNNType _cnntype) : ClassFlowImage(NULL, TAG)
  18. {
  19. string cnnmodelfile = "";
  20. modelxsize = 1;
  21. modelysize = 1;
  22. CNNGoodThreshold = 0.0;
  23. ListFlowControll = NULL;
  24. previousElement = NULL;
  25. SaveAllFiles = false;
  26. disabled = false;
  27. isLogImageSelect = false;
  28. CNNType = AutoDetect;
  29. CNNType = _cnntype;
  30. flowpostalignment = _flowalign;
  31. imagesRetention = 5;
  32. }
  33. string ClassFlowCNNGeneral::getReadout(int _analog = 0, bool _extendedResolution, int prev, float _before_narrow_Analog, float analogDigitalTransitionStart)
  34. {
  35. string result = "";
  36. if (GENERAL[_analog]->ROI.size() == 0)
  37. return result;
  38. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout _analog=" + std::to_string(_analog) + ", _extendedResolution=" + std::to_string(_extendedResolution) + ", prev=" + std::to_string(prev));
  39. if (CNNType == Analogue || CNNType == Analogue100)
  40. {
  41. float number = GENERAL[_analog]->ROI[GENERAL[_analog]->ROI.size() - 1]->result_float;
  42. int result_after_decimal_point = ((int) floor(number * 10) + 10) % 10;
  43. prev = PointerEvalAnalogNew(GENERAL[_analog]->ROI[GENERAL[_analog]->ROI.size() - 1]->result_float, prev);
  44. // LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout(analog) number=" + std::to_string(number) + ", result_after_decimal_point=" + std::to_string(result_after_decimal_point) + ", prev=" + std::to_string(prev));
  45. result = std::to_string(prev);
  46. if (_extendedResolution)
  47. result = result + std::to_string(result_after_decimal_point);
  48. for (int i = GENERAL[_analog]->ROI.size() - 2; i >= 0; --i)
  49. {
  50. prev = PointerEvalAnalogNew(GENERAL[_analog]->ROI[i]->result_float, prev);
  51. result = std::to_string(prev) + result;
  52. }
  53. return result;
  54. }
  55. if (CNNType == Digital)
  56. {
  57. for (int i = 0; i < GENERAL[_analog]->ROI.size(); ++i)
  58. {
  59. if (GENERAL[_analog]->ROI[i]->result_klasse >= 10)
  60. result = result + "N";
  61. else
  62. result = result + std::to_string(GENERAL[_analog]->ROI[i]->result_klasse);
  63. }
  64. return result;
  65. }
  66. if ((CNNType == DoubleHyprid10) || (CNNType == Digital100))
  67. {
  68. float number = GENERAL[_analog]->ROI[GENERAL[_analog]->ROI.size() - 1]->result_float;
  69. if (number >= 0) // NaN?
  70. {
  71. if (_extendedResolution) // is only set if it is the first digit (no analogue before!)
  72. {
  73. int result_after_decimal_point = ((int) floor(number * 10)) % 10;
  74. int result_before_decimal_point = ((int) floor(number)) % 10;
  75. result = std::to_string(result_before_decimal_point) + std::to_string(result_after_decimal_point);
  76. prev = result_before_decimal_point;
  77. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout(dig100-ext) result_before_decimal_point=" + std::to_string(result_before_decimal_point) + ", result_after_decimal_point=" + std::to_string(result_after_decimal_point) + ", prev=" + std::to_string(prev));
  78. }
  79. else
  80. {
  81. if (_before_narrow_Analog >= 0)
  82. prev = PointerEvalHybridNew(GENERAL[_analog]->ROI[GENERAL[_analog]->ROI.size() - 1]->result_float, _before_narrow_Analog, prev, true, analogDigitalTransitionStart);
  83. else
  84. prev = PointerEvalHybridNew(GENERAL[_analog]->ROI[GENERAL[_analog]->ROI.size() - 1]->result_float, prev, prev);
  85. result = std::to_string(prev);
  86. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout(dig100) prev=" + std::to_string(prev));
  87. }
  88. }
  89. else
  90. {
  91. result = "N";
  92. if (_extendedResolution && (CNNType != Digital))
  93. result = "NN";
  94. }
  95. for (int i = GENERAL[_analog]->ROI.size() - 2; i >= 0; --i)
  96. {
  97. if (GENERAL[_analog]->ROI[i]->result_float >= 0)
  98. {
  99. prev = PointerEvalHybridNew(GENERAL[_analog]->ROI[i]->result_float, GENERAL[_analog]->ROI[i+1]->result_float, prev);
  100. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout#PointerEvalHybridNew()= " + std::to_string(prev));
  101. result = std::to_string(prev) + result;
  102. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout#result= " + result);
  103. }
  104. else
  105. {
  106. prev = -1;
  107. result = "N" + result;
  108. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "getReadout(result_float<0 /'N') result_float=" + std::to_string(GENERAL[_analog]->ROI[i]->result_float));
  109. }
  110. }
  111. return result;
  112. }
  113. return result;
  114. }
  115. int ClassFlowCNNGeneral::PointerEvalHybridNew(float number, float number_of_predecessors, int eval_predecessors, bool Analog_Predecessors, float digitalAnalogTransitionStart)
  116. {
  117. int result;
  118. int result_after_decimal_point = ((int) floor(number * 10)) % 10;
  119. int result_before_decimal_point = ((int) floor(number) + 10) % 10;
  120. if (eval_predecessors < 0)
  121. {
  122. // on first digit is no spezial logic for transition needed
  123. // we use the recognition as given. The result is the int value of the recognition
  124. // add precisition of 2 digits and round before trunc
  125. result = (int) ((int) trunc(round((number+10 % 10)*100)) ) / 100;
  126. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalHybridNew - No predecessor - Result = " + std::to_string(result) +
  127. " number: " + std::to_string(number) + " number_of_predecessors = " + std::to_string(number_of_predecessors)+ " eval_predecessors = " + std::to_string(eval_predecessors) + " Digital_Uncertainty = " + std::to_string(Digital_Uncertainty));
  128. return result;
  129. }
  130. if (Analog_Predecessors)
  131. {
  132. result = PointerEvalAnalogToDigitNew(number, number_of_predecessors, eval_predecessors, digitalAnalogTransitionStart);
  133. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalHybridNew - Analog predecessor, evaluation over PointerEvalAnalogNew = " + std::to_string(result) +
  134. " number: " + std::to_string(number) + " number_of_predecessors = " + std::to_string(number_of_predecessors)+ " eval_predecessors = " + std::to_string(eval_predecessors) + " Digital_Uncertainty = " + std::to_string(Digital_Uncertainty));
  135. return result;
  136. }
  137. if ((number_of_predecessors > Digital_Transition_Area_Predecessor ) && (number_of_predecessors < (10.0 - Digital_Transition_Area_Predecessor)))
  138. {
  139. // no digit change, because predecessor is far enough away (0+/-DigitalTransitionRangePredecessor) --> number is rounded
  140. if ((result_after_decimal_point <= DigitalBand) || (result_after_decimal_point >= (10-DigitalBand))) // Band around the digit --> Round off, as digit reaches inaccuracy in the frame
  141. result = ((int) round(number) + 10) % 10;
  142. else
  143. result = ((int) trunc(number) + 10) % 10;
  144. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalHybridNew - NO analogue predecessor, no change of digits, as pre-decimal point far enough away = " + std::to_string(result) +
  145. " number: " + std::to_string(number) + " number_of_predecessors = " + std::to_string(number_of_predecessors)+ " eval_predecessors = " + std::to_string(eval_predecessors) + " Digital_Uncertainty = " + std::to_string(Digital_Uncertainty));
  146. return result;
  147. }
  148. if (eval_predecessors <= 1) // Zero crossing at the predecessor has taken place (! evaluation via Prev_value and not number!) --> round up here (2.8 --> 3, but also 3.1 --> 3)
  149. {
  150. // We simply assume that the current digit after the zero crossing of the predecessor
  151. // has passed through at least half (x.5)
  152. if (result_after_decimal_point > 5)
  153. // The current digit does not yet have a zero crossing, but the predecessor does..
  154. result = (result_before_decimal_point + 1) % 10;
  155. else
  156. // Act. digit and predecessor have zero crossing
  157. result = result_before_decimal_point % 10;
  158. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalHybridNew - NO analogue predecessor, zero crossing has taken placen = " + std::to_string(result) +
  159. " number: " + std::to_string(number) + " number_of_predecessors = " + std::to_string(number_of_predecessors)+ " eval_predecessors = " + std::to_string(eval_predecessors) + " Digital_Uncertainty = " + std::to_string(Digital_Uncertainty));
  160. return result;
  161. }
  162. // remains only >= 9.x --> no zero crossing yet --> 2.8 --> 2,
  163. // and from 9.7(DigitalTransitionRangeLead) 3.1 --> 2
  164. // everything >=x.4 can be considered as current number in transition. With 9.x predecessor the current
  165. // number can still be x.6 - x.7.
  166. // Preceding (else - branch) does not already happen from 9.
  167. if (((Digital_Transition_Area_Forward>=number_of_predecessors) && (eval_predecessors == (int)number_of_predecessors))
  168. || result_after_decimal_point >= 4)
  169. // The current digit, like the previous digit, does not yet have a zero crossing.
  170. result = result_before_decimal_point % 10;
  171. else
  172. // current digit precedes the smaller digit (9.x). So already >=x.0 while the previous digit has not yet
  173. // has no zero crossing. Therefore, it is reduced by 1.
  174. result = (result_before_decimal_point - 1 + 10) % 10;
  175. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalHybridNew - O analogue predecessor, >= 9.5 --> no zero crossing yet = " + std::to_string(result) +
  176. " number: " + std::to_string(number) + " number_of_predecessors = " + std::to_string(number_of_predecessors)+ " eval_predecessors = " + std::to_string(eval_predecessors) + " Digital_Uncertainty = " + std::to_string(Digital_Uncertainty) + " result_after_decimal_point = " + std::to_string(result_after_decimal_point));
  177. return result;
  178. }
  179. int ClassFlowCNNGeneral::PointerEvalAnalogToDigitNew(float number, float numeral_preceder, int eval_predecessors, float analogDigitalTransitionStart)
  180. {
  181. int result;
  182. int result_after_decimal_point = ((int) floor(number * 10)) % 10;
  183. int result_before_decimal_point = ((int) floor(number) + 10) % 10;
  184. bool roundedUp = false;
  185. // Within the digital inequalities
  186. if ((result_after_decimal_point >= (10-Digital_Uncertainty * 10) && ((int)numeral_preceder == eval_predecessors)) // Band around the digit --> Round off, as digit reaches inaccuracy in the frame
  187. || (eval_predecessors <= 4 && result_after_decimal_point>=6)) { // or digit runs after (analogue =0..4, digit >=6)
  188. result = (int) (round(number) + 10) % 10;
  189. roundedUp = true;
  190. // before/ after decimal point, because we adjust the number based on the uncertainty.
  191. result_after_decimal_point = ((int) floor(result * 10)) % 10;
  192. result_before_decimal_point = ((int) floor(result) + 10) % 10;
  193. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogToDigitNew - Digital Uncertainty - Result = " + std::to_string(result) +
  194. " number: " + std::to_string(number) + " numeral_preceder: " + std::to_string(numeral_preceder) +
  195. " erg before comma: " + std::to_string(result_before_decimal_point) +
  196. " erg after comma: " + std::to_string(result_after_decimal_point));
  197. }
  198. else if (result_after_decimal_point < Digital_Uncertainty && numeral_preceder > analogDigitalTransitionStart) {
  199. result = ((result_before_decimal_point+10) - 1) % 10;
  200. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogToDigitNew - Digital Uncertainty - Too early zero crossing - Result = " + std::to_string(result) +
  201. " number: " + std::to_string(number) + " numeral_preceder: " + std::to_string(numeral_preceder) +
  202. " erg before comma: " + std::to_string(result_before_decimal_point) +
  203. " erg after comma: " + std::to_string(result_after_decimal_point));
  204. }
  205. else {
  206. result = (int) ((int) trunc(number) + 10) % 10;
  207. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogToDigitNew - NO digital Uncertainty - Result = " + std::to_string(result) +
  208. " number: " + std::to_string(number) + " numeral_preceder = " + std::to_string(numeral_preceder));
  209. }
  210. // No zero crossing has taken place.
  211. // Only eval_predecessors used because numeral_preceder could be wrong here.
  212. // numeral_preceder<=0.1 & eval_predecessors=9 corresponds to analogue was reset because of previous analogue that are not yet at 0.
  213. if ((eval_predecessors >= 3 && (numeral_preceder > analogDigitalTransitionStart) && roundedUp))
  214. {
  215. result = ((result_before_decimal_point+10) - 1) % 10;
  216. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogToDigitNew - No correction = " + std::to_string(result) +
  217. " number: " + std::to_string(number) +
  218. " numeral_preceder = " + std::to_string(numeral_preceder) +
  219. " eerg after comma = " + std::to_string(result_after_decimal_point));
  220. }
  221. return result;
  222. }
  223. int ClassFlowCNNGeneral::PointerEvalAnalogNew(float number, int numeral_preceder)
  224. {
  225. float number_min, number_max;
  226. int result;
  227. if (numeral_preceder == -1)
  228. {
  229. result = (int) floor(number);
  230. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogNew - No predecessor - Result = " + std::to_string(result) +
  231. " number: " + std::to_string(number) + " numeral_preceder = " + std::to_string(numeral_preceder) + " Analog_error = " + std::to_string(Analog_error));
  232. return result;
  233. }
  234. number_min = number - Analog_error / 10.0;
  235. number_max = number + Analog_error / 10.0;
  236. if ((int) floor(number_max) - (int) floor(number_min) != 0)
  237. {
  238. if (numeral_preceder <= Analog_error)
  239. {
  240. result = ((int) floor(number_max) + 10) % 10;
  241. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogNew - number ambiguous, correction upwards - result = " + std::to_string(result) +
  242. " number: " + std::to_string(number) + " numeral_preceder = " + std::to_string(numeral_preceder) + " Analog_error = " + std::to_string(Analog_error));
  243. return result;
  244. }
  245. if (numeral_preceder >= 10 - Analog_error)
  246. {
  247. result = ((int) floor(number_min) + 10) % 10;
  248. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogNew - number ambiguous, downward correction - result = " + std::to_string(result) +
  249. " number: " + std::to_string(number) + " numeral_preceder = " + std::to_string(numeral_preceder) + " Analog_error = " + std::to_string(Analog_error));
  250. return result;
  251. }
  252. }
  253. result = ((int) floor(number) + 10) % 10;
  254. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "PointerEvalAnalogNew - number unambiguous, no correction necessary - result = " + std::to_string(result) +
  255. " number: " + std::to_string(number) + " numeral_preceder = " + std::to_string(numeral_preceder) + " Analog_error = " + std::to_string(Analog_error));
  256. return result;
  257. }
  258. bool ClassFlowCNNGeneral::ReadParameter(FILE* pfile, string& aktparamgraph)
  259. {
  260. std::vector<string> splitted;
  261. aktparamgraph = trim(aktparamgraph);
  262. if (aktparamgraph.size() == 0)
  263. if (!this->GetNextParagraph(pfile, aktparamgraph))
  264. return false;
  265. if ((toUpper(aktparamgraph) != "[ANALOG]") && (toUpper(aktparamgraph) != ";[ANALOG]")
  266. && (toUpper(aktparamgraph) != "[DIGIT]") && (toUpper(aktparamgraph) != ";[DIGIT]")
  267. && (toUpper(aktparamgraph) != "[DIGITS]") && (toUpper(aktparamgraph) != ";[DIGITS]")
  268. ) // Paragraph passt nicht
  269. return false;
  270. if (aktparamgraph[0] == ';')
  271. {
  272. disabled = true;
  273. while (getNextLine(pfile, &aktparamgraph) && !isNewParagraph(aktparamgraph));
  274. ESP_LOGD(TAG, "[Analog/Digit] is disabled!");
  275. return true;
  276. }
  277. while (this->getNextLine(pfile, &aktparamgraph) && !this->isNewParagraph(aktparamgraph))
  278. {
  279. splitted = ZerlegeZeile(aktparamgraph);
  280. if ((toUpper(splitted[0]) == "ROIIMAGESLOCATION") && (splitted.size() > 1))
  281. {
  282. this->imagesLocation = "/sdcard" + splitted[1];
  283. this->isLogImage = true;
  284. }
  285. if ((toUpper(splitted[0]) == "LOGIMAGESELECT") && (splitted.size() > 1))
  286. {
  287. LogImageSelect = splitted[1];
  288. isLogImageSelect = true;
  289. }
  290. if ((toUpper(splitted[0]) == "ROIIMAGESRETENTION") && (splitted.size() > 1))
  291. {
  292. this->imagesRetention = std::stoi(splitted[1]);
  293. }
  294. if ((toUpper(splitted[0]) == "MODEL") && (splitted.size() > 1))
  295. {
  296. this->cnnmodelfile = splitted[1];
  297. }
  298. if ((toUpper(splitted[0]) == "CNNGOODTHRESHOLD") && (splitted.size() > 1))
  299. {
  300. CNNGoodThreshold = std::stof(splitted[1]);
  301. }
  302. if (splitted.size() >= 5)
  303. {
  304. general* _analog = GetGENERAL(splitted[0], true);
  305. roi* neuroi = _analog->ROI[_analog->ROI.size()-1];
  306. neuroi->posx = std::stoi(splitted[1]);
  307. neuroi->posy = std::stoi(splitted[2]);
  308. neuroi->deltax = std::stoi(splitted[3]);
  309. neuroi->deltay = std::stoi(splitted[4]);
  310. neuroi->CCW = false;
  311. if (splitted.size() >= 6)
  312. {
  313. neuroi->CCW = toUpper(splitted[5]) == "TRUE";
  314. }
  315. neuroi->result_float = -1;
  316. neuroi->image = NULL;
  317. neuroi->image_org = NULL;
  318. }
  319. if ((toUpper(splitted[0]) == "SAVEALLFILES") && (splitted.size() > 1))
  320. {
  321. if (toUpper(splitted[1]) == "TRUE")
  322. SaveAllFiles = true;
  323. }
  324. }
  325. if (!getNetworkParameter()) {
  326. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "An error occured on setting up the Network -> Disabling it!");
  327. disabled = true; // An error occured, disable this CNN!
  328. return false;
  329. }
  330. for (int _ana = 0; _ana < GENERAL.size(); ++_ana)
  331. for (int i = 0; i < GENERAL[_ana]->ROI.size(); ++i)
  332. {
  333. GENERAL[_ana]->ROI[i]->image = new CImageBasis("ROI " + GENERAL[_ana]->ROI[i]->name,
  334. modelxsize, modelysize, modelchannel);
  335. GENERAL[_ana]->ROI[i]->image_org = new CImageBasis("ROI " + GENERAL[_ana]->ROI[i]->name + " original",
  336. GENERAL[_ana]->ROI[i]->deltax, GENERAL[_ana]->ROI[i]->deltay, 3);
  337. }
  338. return true;
  339. }
  340. general* ClassFlowCNNGeneral::FindGENERAL(string _name_number)
  341. {
  342. for (int i = 0; i < GENERAL.size(); ++i)
  343. if (GENERAL[i]->name == _name_number)
  344. return GENERAL[i];
  345. return NULL;
  346. }
  347. general* ClassFlowCNNGeneral::GetGENERAL(string _name, bool _create = true)
  348. {
  349. string _analog, _roi;
  350. int _pospunkt = _name.find_first_of(".");
  351. if (_pospunkt > -1)
  352. {
  353. _analog = _name.substr(0, _pospunkt);
  354. _roi = _name.substr(_pospunkt+1, _name.length() - _pospunkt - 1);
  355. }
  356. else
  357. {
  358. _analog = "default";
  359. _roi = _name;
  360. }
  361. general *_ret = NULL;
  362. for (int i = 0; i < GENERAL.size(); ++i)
  363. if (GENERAL[i]->name == _analog)
  364. _ret = GENERAL[i];
  365. if (!_create) // not found and should not be created
  366. return _ret;
  367. if (_ret == NULL)
  368. {
  369. _ret = new general;
  370. _ret->name = _analog;
  371. GENERAL.push_back(_ret);
  372. }
  373. roi* neuroi = new roi;
  374. neuroi->name = _roi;
  375. _ret->ROI.push_back(neuroi);
  376. ESP_LOGD(TAG, "GetGENERAL - GENERAL %s - roi %s - CCW: %d", _analog.c_str(), _roi.c_str(), neuroi->CCW);
  377. return _ret;
  378. }
  379. string ClassFlowCNNGeneral::getHTMLSingleStep(string host)
  380. {
  381. string result, zw;
  382. std::vector<HTMLInfo*> htmlinfo;
  383. result = "<p>Found ROIs: </p> <p><img src=\"" + host + "/img_tmp/alg_roi.jpg\"></p>\n";
  384. result = result + "Analog Pointers: <p> ";
  385. htmlinfo = GetHTMLInfo();
  386. for (int i = 0; i < htmlinfo.size(); ++i)
  387. {
  388. std::stringstream stream;
  389. stream << std::fixed << std::setprecision(1) << htmlinfo[i]->val;
  390. zw = stream.str();
  391. result = result + "<img src=\"" + host + "/img_tmp/" + htmlinfo[i]->filename + "\"> " + zw;
  392. delete htmlinfo[i];
  393. }
  394. htmlinfo.clear();
  395. return result;
  396. }
  397. bool ClassFlowCNNGeneral::doFlow(string time)
  398. {
  399. #ifdef HEAP_TRACING_CLASS_FLOW_CNN_GENERAL_DO_ALING_AND_CUT
  400. //register a buffer to record the memory trace
  401. ESP_ERROR_CHECK( heap_trace_init_standalone(trace_record, NUM_RECORDS) );
  402. // start tracing
  403. ESP_ERROR_CHECK( heap_trace_start(HEAP_TRACE_LEAKS) );
  404. #endif
  405. if (disabled)
  406. return true;
  407. if (!doAlignAndCut(time)){
  408. return false;
  409. }
  410. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "doFlow after alignment");
  411. doNeuralNetwork(time);
  412. RemoveOldLogs();
  413. #ifdef HEAP_TRACING_CLASS_FLOW_CNN_GENERAL_DO_ALING_AND_CUT
  414. ESP_ERROR_CHECK( heap_trace_stop() );
  415. heap_trace_dump();
  416. #endif
  417. return true;
  418. }
  419. bool ClassFlowCNNGeneral::doAlignAndCut(string time)
  420. {
  421. if (disabled)
  422. return true;
  423. CAlignAndCutImage *caic = flowpostalignment->GetAlignAndCutImage();
  424. for (int _ana = 0; _ana < GENERAL.size(); ++_ana)
  425. for (int i = 0; i < GENERAL[_ana]->ROI.size(); ++i)
  426. {
  427. ESP_LOGD(TAG, "General %d - Align&Cut", i);
  428. caic->CutAndSave(GENERAL[_ana]->ROI[i]->posx, GENERAL[_ana]->ROI[i]->posy, GENERAL[_ana]->ROI[i]->deltax, GENERAL[_ana]->ROI[i]->deltay, GENERAL[_ana]->ROI[i]->image_org);
  429. if (SaveAllFiles)
  430. {
  431. if (GENERAL[_ana]->name == "default")
  432. GENERAL[_ana]->ROI[i]->image_org->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  433. else
  434. GENERAL[_ana]->ROI[i]->image_org->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->name + "_" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  435. }
  436. GENERAL[_ana]->ROI[i]->image_org->Resize(modelxsize, modelysize, GENERAL[_ana]->ROI[i]->image);
  437. if (SaveAllFiles)
  438. {
  439. if (GENERAL[_ana]->name == "default")
  440. GENERAL[_ana]->ROI[i]->image->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  441. else
  442. GENERAL[_ana]->ROI[i]->image->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->name + "_" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  443. }
  444. }
  445. return true;
  446. }
  447. void ClassFlowCNNGeneral::DrawROI(CImageBasis *_zw)
  448. {
  449. if (_zw->ImageOkay())
  450. {
  451. if (CNNType == Analogue || CNNType == Analogue100)
  452. {
  453. int r = 0;
  454. int g = 255;
  455. int b = 0;
  456. for (int _ana = 0; _ana < GENERAL.size(); ++_ana)
  457. for (int i = 0; i < GENERAL[_ana]->ROI.size(); ++i)
  458. {
  459. _zw->drawRect(GENERAL[_ana]->ROI[i]->posx, GENERAL[_ana]->ROI[i]->posy, GENERAL[_ana]->ROI[i]->deltax, GENERAL[_ana]->ROI[i]->deltay, r, g, b, 1);
  460. _zw->drawEllipse( (int) (GENERAL[_ana]->ROI[i]->posx + GENERAL[_ana]->ROI[i]->deltax/2), (int) (GENERAL[_ana]->ROI[i]->posy + GENERAL[_ana]->ROI[i]->deltay/2), (int) (GENERAL[_ana]->ROI[i]->deltax/2), (int) (GENERAL[_ana]->ROI[i]->deltay/2), r, g, b, 2);
  461. _zw->drawLine((int) (GENERAL[_ana]->ROI[i]->posx + GENERAL[_ana]->ROI[i]->deltax/2), (int) GENERAL[_ana]->ROI[i]->posy, (int) (GENERAL[_ana]->ROI[i]->posx + GENERAL[_ana]->ROI[i]->deltax/2), (int) (GENERAL[_ana]->ROI[i]->posy + GENERAL[_ana]->ROI[i]->deltay), r, g, b, 2);
  462. _zw->drawLine((int) GENERAL[_ana]->ROI[i]->posx, (int) (GENERAL[_ana]->ROI[i]->posy + GENERAL[_ana]->ROI[i]->deltay/2), (int) GENERAL[_ana]->ROI[i]->posx + GENERAL[_ana]->ROI[i]->deltax, (int) (GENERAL[_ana]->ROI[i]->posy + GENERAL[_ana]->ROI[i]->deltay/2), r, g, b, 2);
  463. }
  464. }
  465. else
  466. {
  467. for (int _dig = 0; _dig < GENERAL.size(); ++_dig)
  468. for (int i = 0; i < GENERAL[_dig]->ROI.size(); ++i)
  469. _zw->drawRect(GENERAL[_dig]->ROI[i]->posx, GENERAL[_dig]->ROI[i]->posy, GENERAL[_dig]->ROI[i]->deltax, GENERAL[_dig]->ROI[i]->deltay, 0, 0, (255 - _dig*100), 2);
  470. }
  471. }
  472. }
  473. bool ClassFlowCNNGeneral::getNetworkParameter()
  474. {
  475. if (disabled)
  476. return true;
  477. CTfLiteClass *tflite = new CTfLiteClass;
  478. string zwcnn = "/sdcard" + cnnmodelfile;
  479. zwcnn = FormatFileName(zwcnn);
  480. ESP_LOGD(TAG, "%s", zwcnn.c_str());
  481. if (!tflite->LoadModel(zwcnn)) {
  482. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "Can't load tflite model " + cnnmodelfile + " -> Init aborted!");
  483. LogFile.WriteHeapInfo("getNetworkParameter-LoadModel");
  484. delete tflite;
  485. return false;
  486. }
  487. if (!tflite->MakeAllocate()) {
  488. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "Can't allocate tflite model -> Init aborted!");
  489. LogFile.WriteHeapInfo("getNetworkParameter-MakeAllocate");
  490. delete tflite;
  491. return false;
  492. }
  493. if (CNNType == AutoDetect)
  494. {
  495. tflite->GetInputDimension(false);
  496. modelxsize = tflite->ReadInputDimenstion(0);
  497. modelysize = tflite->ReadInputDimenstion(1);
  498. modelchannel = tflite->ReadInputDimenstion(2);
  499. int _anzoutputdimensions = tflite->GetAnzOutPut();
  500. switch (_anzoutputdimensions)
  501. {
  502. case 2:
  503. CNNType = Analogue;
  504. ESP_LOGD(TAG, "TFlite-Type set to Analogue");
  505. break;
  506. case 10:
  507. CNNType = DoubleHyprid10;
  508. ESP_LOGD(TAG, "TFlite-Type set to DoubleHyprid10");
  509. break;
  510. case 11:
  511. CNNType = Digital;
  512. ESP_LOGD(TAG, "TFlite-Type set to Digital");
  513. break;
  514. /* case 20:
  515. CNNType = DigitalHyprid10;
  516. ESP_LOGD(TAG, "TFlite-Type set to DigitalHyprid10");
  517. break;
  518. */
  519. // case 22:
  520. // CNNType = DigitalHyprid;
  521. // ESP_LOGD(TAG, "TFlite-Type set to DigitalHyprid");
  522. // break;
  523. case 100:
  524. if (modelxsize==32 && modelysize == 32) {
  525. CNNType = Analogue100;
  526. ESP_LOGD(TAG, "TFlite-Type set to Analogue100");
  527. } else {
  528. CNNType = Digital100;
  529. ESP_LOGD(TAG, "TFlite-Type set to Digital");
  530. }
  531. break;
  532. default:
  533. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "tflite does not fit the firmware (outout_dimension=" + std::to_string(_anzoutputdimensions) + ")");
  534. }
  535. }
  536. delete tflite;
  537. return true;
  538. }
  539. bool ClassFlowCNNGeneral::doNeuralNetwork(string time)
  540. {
  541. if (disabled)
  542. return true;
  543. string logPath = CreateLogFolder(time);
  544. CTfLiteClass *tflite = new CTfLiteClass;
  545. string zwcnn = "/sdcard" + cnnmodelfile;
  546. zwcnn = FormatFileName(zwcnn);
  547. ESP_LOGD(TAG, "%s", zwcnn.c_str());
  548. if (!tflite->LoadModel(zwcnn)) {
  549. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "Can't load tflite model " + cnnmodelfile + " -> Exec aborted this round!");
  550. LogFile.WriteHeapInfo("doNeuralNetwork-LoadModel");
  551. delete tflite;
  552. return false;
  553. }
  554. if (!tflite->MakeAllocate()) {
  555. LogFile.WriteToFile(ESP_LOG_ERROR, TAG, "Can't allocate tfilte model -> Exec aborted this round!");
  556. LogFile.WriteHeapInfo("doNeuralNetwork-MakeAllocate");
  557. delete tflite;
  558. return false;
  559. }
  560. for (int n = 0; n < GENERAL.size(); ++n) // For each NUMBER
  561. {
  562. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "Processing Number '" + GENERAL[n]->name + "'");
  563. for (int roi = 0; roi < GENERAL[n]->ROI.size(); ++roi) // For each ROI
  564. {
  565. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "ROI #" + std::to_string(roi) + " - TfLite");
  566. //ESP_LOGD(TAG, "General %d - TfLite", i);
  567. switch (CNNType) {
  568. case Analogue:
  569. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "CNN Type: Analogue");
  570. {
  571. float f1, f2;
  572. f1 = 0; f2 = 0;
  573. tflite->LoadInputImageBasis(GENERAL[n]->ROI[roi]->image);
  574. tflite->Invoke();
  575. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "After Invoke");
  576. f1 = tflite->GetOutputValue(0);
  577. f2 = tflite->GetOutputValue(1);
  578. float result = fmod(atan2(f1, f2) / (M_PI * 2) + 2, 1);
  579. if(GENERAL[n]->ROI[roi]->CCW)
  580. GENERAL[n]->ROI[roi]->result_float = 10 - (result * 10);
  581. else
  582. GENERAL[n]->ROI[roi]->result_float = result * 10;
  583. ESP_LOGD(TAG, "General result (Analog)%i - CCW: %d - %f", roi, GENERAL[n]->ROI[roi]->CCW, GENERAL[n]->ROI[roi]->result_float);
  584. if (isLogImage)
  585. LogImage(logPath, GENERAL[n]->ROI[roi]->name, &GENERAL[n]->ROI[roi]->result_float, NULL, time, GENERAL[n]->ROI[roi]->image_org);
  586. } break;
  587. case Digital:
  588. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "CNN Type: Digital");
  589. {
  590. GENERAL[n]->ROI[roi]->result_klasse = 0;
  591. GENERAL[n]->ROI[roi]->result_klasse = tflite->GetClassFromImageBasis(GENERAL[n]->ROI[roi]->image);
  592. ESP_LOGD(TAG, "General result (Digit)%i: %d", roi, GENERAL[n]->ROI[roi]->result_klasse);
  593. if (isLogImage)
  594. {
  595. string _imagename = GENERAL[n]->name + "_" + GENERAL[n]->ROI[roi]->name;
  596. if (isLogImageSelect)
  597. {
  598. if (LogImageSelect.find(GENERAL[n]->ROI[roi]->name) != std::string::npos)
  599. LogImage(logPath, _imagename, NULL, &GENERAL[n]->ROI[roi]->result_klasse, time, GENERAL[n]->ROI[roi]->image_org);
  600. }
  601. else
  602. {
  603. LogImage(logPath, _imagename, NULL, &GENERAL[n]->ROI[roi]->result_klasse, time, GENERAL[n]->ROI[roi]->image_org);
  604. }
  605. }
  606. } break;
  607. case DoubleHyprid10:
  608. {
  609. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "CNN Type: DoubleHyprid10");
  610. int _num, _numplus, _numminus;
  611. float _val, _valplus, _valminus;
  612. float _fit;
  613. float _result_save_file;
  614. tflite->LoadInputImageBasis(GENERAL[n]->ROI[roi]->image);
  615. tflite->Invoke();
  616. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "After Invoke");
  617. _num = tflite->GetOutClassification(0, 9);
  618. _numplus = (_num + 1) % 10;
  619. _numminus = (_num - 1 + 10) % 10;
  620. _val = tflite->GetOutputValue(_num);
  621. _valplus = tflite->GetOutputValue(_numplus);
  622. _valminus = tflite->GetOutputValue(_numminus);
  623. float result = _num;
  624. if (_valplus > _valminus)
  625. {
  626. result = result + _valplus / (_valplus + _val);
  627. _fit = _val + _valplus;
  628. }
  629. else
  630. {
  631. result = result - _valminus / (_val + _valminus);
  632. _fit = _val + _valminus;
  633. }
  634. if (result >= 10)
  635. result = result - 10;
  636. if (result < 0)
  637. result = result + 10;
  638. string zw = "_num (p, m): " + to_string(_num) + " " + to_string(_numplus) + " " + to_string(_numminus);
  639. zw = zw + " _val (p, m): " + to_string(_val) + " " + to_string(_valplus) + " " + to_string(_valminus);
  640. zw = zw + " result: " + to_string(result) + " _fit: " + to_string(_fit);
  641. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, zw);
  642. _result_save_file = result;
  643. if (_fit < CNNGoodThreshold)
  644. {
  645. GENERAL[n]->ROI[roi]->isReject = true;
  646. result = -1;
  647. _result_save_file+= 100; // In case fit is not sufficient, the result should still be saved with "-10x.y".
  648. string zw = "Value Rejected due to Threshold (Fit: " + to_string(_fit) + ", Threshold: " + to_string(CNNGoodThreshold) + ")";
  649. LogFile.WriteToFile(ESP_LOG_WARN, TAG, zw);
  650. }
  651. else
  652. {
  653. GENERAL[n]->ROI[roi]->isReject = false;
  654. }
  655. GENERAL[n]->ROI[roi]->result_float = result;
  656. ESP_LOGD(TAG, "Result General(Analog)%i: %f", roi, GENERAL[n]->ROI[roi]->result_float);
  657. if (isLogImage)
  658. {
  659. string _imagename = GENERAL[n]->name + "_" + GENERAL[n]->ROI[roi]->name;
  660. if (isLogImageSelect)
  661. {
  662. if (LogImageSelect.find(GENERAL[n]->ROI[roi]->name) != std::string::npos)
  663. LogImage(logPath, _imagename, &_result_save_file, NULL, time, GENERAL[n]->ROI[roi]->image_org);
  664. }
  665. else
  666. {
  667. LogImage(logPath, _imagename, &_result_save_file, NULL, time, GENERAL[n]->ROI[roi]->image_org);
  668. }
  669. }
  670. }
  671. break;
  672. case Digital100:
  673. case Analogue100:
  674. {
  675. LogFile.WriteToFile(ESP_LOG_DEBUG, TAG, "CNN Type: Digital100 or Analogue100");
  676. int _num;
  677. float _result_save_file;
  678. tflite->LoadInputImageBasis(GENERAL[n]->ROI[roi]->image);
  679. tflite->Invoke();
  680. _num = tflite->GetOutClassification();
  681. if(GENERAL[n]->ROI[roi]->CCW)
  682. GENERAL[n]->ROI[roi]->result_float = 10 - ((float)_num / 10.0);
  683. else
  684. GENERAL[n]->ROI[roi]->result_float = (float)_num / 10.0;
  685. _result_save_file = GENERAL[n]->ROI[roi]->result_float;
  686. GENERAL[n]->ROI[roi]->isReject = false;
  687. ESP_LOGD(TAG, "Result General(Analog)%i - CCW: %d - %f", roi, GENERAL[n]->ROI[roi]->CCW, GENERAL[n]->ROI[roi]->result_float);
  688. if (isLogImage)
  689. {
  690. string _imagename = GENERAL[n]->name + "_" + GENERAL[n]->ROI[roi]->name;
  691. if (isLogImageSelect)
  692. {
  693. if (LogImageSelect.find(GENERAL[n]->ROI[roi]->name) != std::string::npos)
  694. LogImage(logPath, _imagename, &_result_save_file, NULL, time, GENERAL[n]->ROI[roi]->image_org);
  695. }
  696. else
  697. {
  698. LogImage(logPath, _imagename, &_result_save_file, NULL, time, GENERAL[n]->ROI[roi]->image_org);
  699. }
  700. }
  701. } break;
  702. default:
  703. break;
  704. }
  705. }
  706. }
  707. delete tflite;
  708. return true;
  709. }
  710. bool ClassFlowCNNGeneral::isExtendedResolution(int _number)
  711. {
  712. if (CNNType == Digital)
  713. return false;
  714. return true;
  715. }
  716. std::vector<HTMLInfo*> ClassFlowCNNGeneral::GetHTMLInfo()
  717. {
  718. std::vector<HTMLInfo*> result;
  719. for (int _ana = 0; _ana < GENERAL.size(); ++_ana)
  720. for (int i = 0; i < GENERAL[_ana]->ROI.size(); ++i)
  721. {
  722. ESP_LOGD(TAG, "Image: %d", (int) GENERAL[_ana]->ROI[i]->image);
  723. if (GENERAL[_ana]->ROI[i]->image)
  724. {
  725. if (GENERAL[_ana]->name == "default")
  726. GENERAL[_ana]->ROI[i]->image->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  727. else
  728. GENERAL[_ana]->ROI[i]->image->SaveToFile(FormatFileName("/sdcard/img_tmp/" + GENERAL[_ana]->name + "_" + GENERAL[_ana]->ROI[i]->name + ".jpg"));
  729. }
  730. HTMLInfo *zw = new HTMLInfo;
  731. if (GENERAL[_ana]->name == "default")
  732. {
  733. zw->filename = GENERAL[_ana]->ROI[i]->name + ".jpg";
  734. zw->filename_org = GENERAL[_ana]->ROI[i]->name + ".jpg";
  735. }
  736. else
  737. {
  738. zw->filename = GENERAL[_ana]->name + "_" + GENERAL[_ana]->ROI[i]->name + ".jpg";
  739. zw->filename_org = GENERAL[_ana]->name + "_" + GENERAL[_ana]->ROI[i]->name + ".jpg";
  740. }
  741. if (CNNType == Digital)
  742. zw->val = GENERAL[_ana]->ROI[i]->result_klasse;
  743. else
  744. zw->val = GENERAL[_ana]->ROI[i]->result_float;
  745. zw->image = GENERAL[_ana]->ROI[i]->image;
  746. zw->image_org = GENERAL[_ana]->ROI[i]->image_org;
  747. result.push_back(zw);
  748. }
  749. return result;
  750. }
  751. int ClassFlowCNNGeneral::getNumberGENERAL()
  752. {
  753. return GENERAL.size();
  754. }
  755. string ClassFlowCNNGeneral::getNameGENERAL(int _analog)
  756. {
  757. if (_analog < GENERAL.size())
  758. return GENERAL[_analog]->name;
  759. return "GENERAL DOES NOT EXIST";
  760. }
  761. general* ClassFlowCNNGeneral::GetGENERAL(int _analog)
  762. {
  763. if (_analog < GENERAL.size())
  764. return GENERAL[_analog];
  765. return NULL;
  766. }
  767. void ClassFlowCNNGeneral::UpdateNameNumbers(std::vector<std::string> *_name_numbers)
  768. {
  769. for (int _dig = 0; _dig < GENERAL.size(); _dig++)
  770. {
  771. std::string _name = GENERAL[_dig]->name;
  772. bool found = false;
  773. for (int i = 0; i < (*_name_numbers).size(); ++i)
  774. {
  775. if ((*_name_numbers)[i] == _name)
  776. found = true;
  777. }
  778. if (!found)
  779. (*_name_numbers).push_back(_name);
  780. }
  781. }
  782. string ClassFlowCNNGeneral::getReadoutRawString(int _analog)
  783. {
  784. string rt = "";
  785. if (_analog >= GENERAL.size() || GENERAL[_analog]==NULL || GENERAL[_analog]->ROI.size() == 0)
  786. return rt;
  787. for (int i = 0; i < GENERAL[_analog]->ROI.size(); ++i)
  788. {
  789. if (CNNType == Analogue || CNNType == Analogue100)
  790. {
  791. rt = rt + "," + RundeOutput(GENERAL[_analog]->ROI[i]->result_float, 1);
  792. }
  793. if (CNNType == Digital)
  794. {
  795. if (GENERAL[_analog]->ROI[i]->result_klasse == 10)
  796. rt = rt + ",N";
  797. else
  798. rt = rt + "," + RundeOutput(GENERAL[_analog]->ROI[i]->result_klasse, 0);
  799. }
  800. if ((CNNType == DoubleHyprid10) || (CNNType == Digital100))
  801. {
  802. rt = rt + "," + RundeOutput(GENERAL[_analog]->ROI[i]->result_float, 1);
  803. }
  804. }
  805. return rt;
  806. }