myqlock/DCF77Helper.cpp at master · majofi/myqlock · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
/**
 * DCF77Helper.cpp
 * Klasse um die Qualitaet der DCF77-Samples zu verbessern. Dazu wird der Minutenabstand
 * zwischen den empfangenen DCF77-Samples mit Hilfe der DS1307 Echtzeituhr verglichen.
 * Zusaetzlich werden die Datumswerte verglichen.
 *
 * @mc       Arduino/RBBB
 * @autor    Christian Aschoff / caschoff _AT_ mac _DOT_ com
 * @version  1.3
 * @datum    19.3.2011
 *
 * Versionshistorie:
 * V 1.1  - Fehler in der Initialisierung behoben.
 * V 1.2  - Umstellung auf TimeStamps und Verbesserung des Plausibilitaetstests.
 * V 1.3  - Fehler im samplesOk() behoben.
 */
#include "DCF77Helper.h"

// #define DEBUG

/**
 * Initialisierung und das Array 'falsch' vorbelegen
 */
DCF77Helper::DCF77Helper() {
  _cursor = 0;
  for(int i=0; i<DCF77HELPER_MAX_SAMPLES; i++) {
    _zeitstempelDcf77[i].set(i, i, i, i, i, i);
    _zeitstempelRtc[i].set(10000, 0, 0, 0, 0, 0);
  }
}

/**
 * Einen neuen Sample hinzufuegen
 */
void DCF77Helper::addSample(MyDCF77 dcf77, DS1307 ds1307) {
  _zeitstempelDcf77[_cursor].setFrom(dcf77);
  _zeitstempelRtc[_cursor].setFrom(ds1307);

  _cursor++;
  if(_cursor == DCF77HELPER_MAX_SAMPLES) {
    _cursor = 0;
  }
}

/**
 * Die Samples vergleichen
 */
boolean DCF77Helper::samplesOk() {
  for(int i=0; i<DCF77HELPER_MAX_SAMPLES-1; i++) {
    // Teste den Minutenabstand zwischen den Zeitstempeln...
    if((_zeitstempelDcf77[i].getMinutesOfDay() - _zeitstempelDcf77[i+1].getMinutesOfDay()) != (_zeitstempelRtc[i].getMinutesOfDay() - _zeitstempelRtc[i+1].getMinutesOfDay())) {
#ifdef DEBUG
      Serial.print("Diff #");
      Serial.print(i);
      Serial.print(" distance is false (");
      Serial.print(_zeitstempelDcf77[i].getMinutesOfDay() - _zeitstempelDcf77[i+1].getMinutesOfDay());
      Serial.print("!=");
      Serial.print(_zeitstempelRtc[i].getMinutesOfDay() - _zeitstempelRtc[i+1].getMinutesOfDay());
      Serial.println(").");
#endif
      return false;
    }
    else {
#ifdef DEBUG
      Serial.print("Diff #");
      Serial.print(i);
      Serial.print(" distance is ok (");
      Serial.print(_zeitstempelDcf77[i].getMinutesOfDay() - _zeitstempelDcf77[i+1].getMinutesOfDay());
      Serial.print("==");
      Serial.print(_zeitstempelRtc[i].getMinutesOfDay() - _zeitstempelRtc[i+1].getMinutesOfDay());
      Serial.println(").");
#endif
    }
  }

  return true;
}