|  | 
|  | 1 | +/* | 
|  | 2 | + * LegoPowerFunctionsTest: LEGO Power Functions Tests | 
|  | 3 | + * Copyright (c) 2016 Philipp Henkel | 
|  | 4 | + */ | 
|  | 5 | + | 
|  | 6 | +#include <ir_Lego_PF_BitStreamEncoder.h> | 
|  | 7 | + | 
|  | 8 | +void setup() { | 
|  | 9 | +  Serial.begin(9600); | 
|  | 10 | +  delay(1000); // wait for reset triggered by serial connection | 
|  | 11 | +  runBitStreamEncoderTests(); | 
|  | 12 | +} | 
|  | 13 | + | 
|  | 14 | +void loop() { | 
|  | 15 | +} | 
|  | 16 | + | 
|  | 17 | +void runBitStreamEncoderTests() { | 
|  | 18 | +  Serial.println(); | 
|  | 19 | +  Serial.println("BitStreamEncoder Tests"); | 
|  | 20 | +  static LegoPfBitStreamEncoder bitStreamEncoder; | 
|  | 21 | +  testStartBit(bitStreamEncoder); | 
|  | 22 | +  testLowBit(bitStreamEncoder); | 
|  | 23 | +  testHighBit(bitStreamEncoder); | 
|  | 24 | +  testMessageBitCount(bitStreamEncoder); | 
|  | 25 | +  testMessageBitCountRepeat(bitStreamEncoder); | 
|  | 26 | +  testMessage407(bitStreamEncoder); | 
|  | 27 | +  testMessage407Repeated(bitStreamEncoder); | 
|  | 28 | +  testGetChannelId1(bitStreamEncoder); | 
|  | 29 | +  testGetChannelId2(bitStreamEncoder); | 
|  | 30 | +  testGetChannelId3(bitStreamEncoder); | 
|  | 31 | +  testGetChannelId4(bitStreamEncoder); | 
|  | 32 | +  testGetMessageLengthAllHigh(bitStreamEncoder); | 
|  | 33 | +  testGetMessageLengthAllLow(bitStreamEncoder); | 
|  | 34 | +} | 
|  | 35 | + | 
|  | 36 | +void logTestResult(bool testPassed) { | 
|  | 37 | +  if (testPassed) { | 
|  | 38 | +    Serial.println("OK"); | 
|  | 39 | +  } | 
|  | 40 | +  else { | 
|  | 41 | +    Serial.println("FAIL  ############"); | 
|  | 42 | +  } | 
|  | 43 | +} | 
|  | 44 | + | 
|  | 45 | +void testStartBit(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 46 | +  Serial.print("  testStartBit                    "); | 
|  | 47 | +  bitStreamEncoder.reset(0, false); | 
|  | 48 | +  int startMark = bitStreamEncoder.getMarkDuration(); | 
|  | 49 | +  int startPause = bitStreamEncoder.getPauseDuration(); | 
|  | 50 | +  logTestResult(startMark == 158 && startPause == 1184-158); | 
|  | 51 | +} | 
|  | 52 | + | 
|  | 53 | +void testLowBit(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 54 | +  Serial.print("  testLowBit                      "); | 
|  | 55 | +  bitStreamEncoder.reset(0, false); | 
|  | 56 | +  bitStreamEncoder.next(); | 
|  | 57 | +  int lowMark = bitStreamEncoder.getMarkDuration(); | 
|  | 58 | +  int lowPause = bitStreamEncoder.getPauseDuration(); | 
|  | 59 | +  logTestResult(lowMark == 158 && lowPause == 421-158); | 
|  | 60 | +} | 
|  | 61 | + | 
|  | 62 | +void testHighBit(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 63 | +  Serial.print("  testHighBit                     "); | 
|  | 64 | +  bitStreamEncoder.reset(0xFFFF, false); | 
|  | 65 | +  bitStreamEncoder.next(); | 
|  | 66 | +  int highMark = bitStreamEncoder.getMarkDuration(); | 
|  | 67 | +  int highPause = bitStreamEncoder.getPauseDuration(); | 
|  | 68 | +  logTestResult(highMark == 158 && highPause == 711-158); | 
|  | 69 | +} | 
|  | 70 | + | 
|  | 71 | +void testMessageBitCount(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 72 | +  Serial.print("  testMessageBitCount             "); | 
|  | 73 | +  bitStreamEncoder.reset(0xFFFF, false); | 
|  | 74 | +  int bitCount = 1; | 
|  | 75 | +  while (bitStreamEncoder.next()) { | 
|  | 76 | +    bitCount++; | 
|  | 77 | +  } | 
|  | 78 | +  logTestResult(bitCount == 18); | 
|  | 79 | +} | 
|  | 80 | + | 
|  | 81 | +boolean check(LegoPfBitStreamEncoder& bitStreamEncoder, int markDuration, int pauseDuration) { | 
|  | 82 | +  bool result = true; | 
|  | 83 | +  result = result && bitStreamEncoder.getMarkDuration() == markDuration; | 
|  | 84 | +  result = result && bitStreamEncoder.getPauseDuration() == pauseDuration; | 
|  | 85 | +  return result; | 
|  | 86 | +} | 
|  | 87 | + | 
|  | 88 | +boolean checkNext(LegoPfBitStreamEncoder& bitStreamEncoder, int markDuration, int pauseDuration) { | 
|  | 89 | +  bool result = bitStreamEncoder.next(); | 
|  | 90 | +  result = result && check(bitStreamEncoder, markDuration, pauseDuration); | 
|  | 91 | +  return result; | 
|  | 92 | +} | 
|  | 93 | + | 
|  | 94 | +boolean checkDataBitsOfMessage407(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 95 | +  bool result = true; | 
|  | 96 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 97 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 98 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 99 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 100 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 101 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 102 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 103 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 104 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 105 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 106 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 107 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 108 | +  result = result && checkNext(bitStreamEncoder, 158, 263); | 
|  | 109 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 110 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 111 | +  result = result && checkNext(bitStreamEncoder, 158, 553); | 
|  | 112 | +  return result; | 
|  | 113 | +} | 
|  | 114 | + | 
|  | 115 | +void testMessage407(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 116 | +  Serial.print("  testMessage407                  "); | 
|  | 117 | +  bitStreamEncoder.reset(407, false); | 
|  | 118 | +  bool result = true; | 
|  | 119 | +  result = result && check(bitStreamEncoder, 158, 1026); | 
|  | 120 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 121 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 122 | +  result = result && !bitStreamEncoder.next(); | 
|  | 123 | +  logTestResult(result); | 
|  | 124 | +} | 
|  | 125 | + | 
|  | 126 | +void testMessage407Repeated(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 127 | +  Serial.print("  testMessage407Repeated          "); | 
|  | 128 | +  bitStreamEncoder.reset(407, true); | 
|  | 129 | +  bool result = true; | 
|  | 130 | +  result = result && check(bitStreamEncoder, 158, 1026); | 
|  | 131 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 132 | +  result = result && checkNext(bitStreamEncoder, 158, 1026 + 5 * 16000 - 10844); | 
|  | 133 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 134 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 135 | +  result = result && checkNext(bitStreamEncoder, 158, 1026 + 5 * 16000 - 10844); | 
|  | 136 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 137 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 138 | +  result = result && checkNext(bitStreamEncoder, 158, 1026 + 8 * 16000 - 10844); | 
|  | 139 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 140 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 141 | +  result = result && checkNext(bitStreamEncoder, 158, 1026 + 8 * 16000 - 10844); | 
|  | 142 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 143 | +  result = result && checkDataBitsOfMessage407(bitStreamEncoder); | 
|  | 144 | +  result = result && checkNext(bitStreamEncoder, 158, 1026); | 
|  | 145 | +  result = result && !bitStreamEncoder.next(); | 
|  | 146 | +  logTestResult(result); | 
|  | 147 | +} | 
|  | 148 | + | 
|  | 149 | +void testMessageBitCountRepeat(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 150 | +  Serial.print("  testMessageBitCountRepeat       "); | 
|  | 151 | +  bitStreamEncoder.reset(0xFFFF, true); | 
|  | 152 | +  int bitCount = 1; | 
|  | 153 | +  while (bitStreamEncoder.next()) { | 
|  | 154 | +    bitCount++; | 
|  | 155 | +  } | 
|  | 156 | +  logTestResult(bitCount == 5*18); | 
|  | 157 | +} | 
|  | 158 | + | 
|  | 159 | +void testGetChannelId1(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 160 | +  Serial.print("  testGetChannelId1               "); | 
|  | 161 | +  bitStreamEncoder.reset(407, false); | 
|  | 162 | +  logTestResult(bitStreamEncoder.getChannelId() == 1); | 
|  | 163 | +} | 
|  | 164 | + | 
|  | 165 | +void testGetChannelId2(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 166 | +  Serial.print("  testGetChannelId2               "); | 
|  | 167 | +  bitStreamEncoder.reset(4502, false); | 
|  | 168 | +  logTestResult(bitStreamEncoder.getChannelId() == 2); | 
|  | 169 | +} | 
|  | 170 | + | 
|  | 171 | +void testGetChannelId3(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 172 | +  Serial.print("  testGetChannelId3               "); | 
|  | 173 | +  bitStreamEncoder.reset(8597, false); | 
|  | 174 | +  logTestResult(bitStreamEncoder.getChannelId() == 3); | 
|  | 175 | +} | 
|  | 176 | + | 
|  | 177 | +void testGetChannelId4(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 178 | +  Serial.print("  testGetChannelId4               "); | 
|  | 179 | +  bitStreamEncoder.reset(12692, false); | 
|  | 180 | +  logTestResult(bitStreamEncoder.getChannelId() == 4); | 
|  | 181 | +} | 
|  | 182 | + | 
|  | 183 | +void testGetMessageLengthAllHigh(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 184 | +  Serial.print("  testGetMessageLengthAllHigh     "); | 
|  | 185 | +  bitStreamEncoder.reset(0xFFFF, false); | 
|  | 186 | +  logTestResult(bitStreamEncoder.getMessageLength() == 13744); | 
|  | 187 | +} | 
|  | 188 | + | 
|  | 189 | +void testGetMessageLengthAllLow(LegoPfBitStreamEncoder& bitStreamEncoder) { | 
|  | 190 | +  Serial.print("  testGetMessageLengthAllLow      "); | 
|  | 191 | +  bitStreamEncoder.reset(0x0, false); | 
|  | 192 | +  logTestResult(bitStreamEncoder.getMessageLength() == 9104); | 
|  | 193 | +} | 
|  | 194 | + | 
|  | 195 | + | 
|  | 196 | + | 
|  | 197 | + | 
0 commit comments