Added FT817_NBS library (own code) to move critical code into it's own place.

lib/FT817_NBS/FT817_NBS.cpp

@@ -0,0 +1,142 @@
+#include <FT817_NBS.h>
+
+SoftwareSerial serial;
+
+FT817_NBS::FT817_NBS(SoftwareSerial connection){
+  serial = connection;
+}
+
+unsigned long bcdToInt(uint8_t bcd){
+  int byte = (bcd & 0xF0) >> 4;
+  byte *= 10;
+  byte += bcd & 0x0F;
+  return byte;
+}
+
+uint8_t intToBcd(unsigned long value){
+  unsigned long tens = value / 10;
+  value -= tens * 10;
+  unsigned long singles = value;
+  uint8_t returnValue = (tens & 0xF) << 4;
+  returnValue = returnValue | (singles & 0xF);
+  return returnValue;
+}
+
+unsigned long getDevicer(int step){
+  switch (step) {
+  case 0:
+    return 1000000;
+    break;
+  case 1:
+    return 10000;
+    break;
+  case 2:
+    return 100;
+    break;
+  case 3:
+    return 1;
+    break;
+  default:
+    //Serial.println("SHIT"); //CAN'T HAPPEN
+    return 1;
+    break;
+  }
+}
+
+FT817_NBS::SignalMode getSignalMode(uint8_t numericValue){
+  switch (numericValue){
+    case 0x0:
+      return FT817_NBS::SignalMode::LSB;
+      break;
+    case 0x01:
+      return FT817_NBS::SignalMode::USB;
+      break;
+    case 0x02:
+      return FT817_NBS::SignalMode::CW;
+      break;
+    case 0x03:
+      return FT817_NBS::SignalMode::CWR;
+      break;
+    case 0x4:
+      return FT817_NBS::SignalMode::AM;
+      break;
+    case 0x6:
+      return FT817_NBS::SignalMode::WFM;
+      break;
+    case 0x8:
+      return FT817_NBS::SignalMode::FM;
+      break;
+    case 0xA:
+      return FT817_NBS::SignalMode::DIG;
+      break;
+    case 0xC:
+      return FT817_NBS::SignalMode::PKT;
+      break;
+    default:
+      return FT817_NBS::SignalMode::UNKNOWN;
+      break;
+  }
+}
+
+void convertFromValueToBcd(uint8_t *buffer, unsigned long actualValue){
+  for(int partsLeft = 0;partsLeft < 4; partsLeft++){
+    unsigned long part = actualValue / getDevicer(partsLeft);
+    actualValue -= part * getDevicer(partsLeft);
+    uint8_t bcd = intToBcd(part);
+    buffer[partsLeft] = bcd;
+  }
+}
+
+unsigned long convertFromBcdToValue(uint8_t *buffer){
+  unsigned long actualValue = 0;
+  for(int partsleft = 0; partsleft < 4; partsleft++){
+    unsigned long multiplier = getDevicer(partsleft);
+    unsigned long partValue = bcdToInt(buffer[0]);
+    actualValue += (partValue * multiplier);
+  }
+  return actualValue;
+}
+
+void clearAvailableBytes(){
+  if(serial.available() != 0){ //Emptying ft817.available()
+    uint8_t throwAwayBuffer[serial.available()];
+    serial.readBytes(&throwAwayBuffer[0], serial.available());
+  }
+}
+
+void sendCommand(uint8_t *bytes, size_t len){
+  for (unsigned int i = 0; i < len; i++){
+    serial.write(bytes[i]);
+    //Serial.print(String(bytes[i], HEX));
+    delay(1);
+  }
+}
+
+void toggleAB(){
+  clearAvailableBytes();
+  uint8_t data[] = {0x0,0x0,0x0,0x0,0x81};
+  sendCommand(&data[0], sizeof(data));
+}
+
+FT817_NBS::Frequency getFrequency(){
+  clearAvailableBytes();
+  uint8_t data[] = {0x0,0x0,0x0,0x0,0x3};
+  sendCommand(&data[0], sizeof(data));
+
+  delay(10);
+  
+  uint8_t buffer[5];
+  serial.readBytes(&buffer[0], sizeof(buffer));
+  FT817_NBS::Frequency frequency;
+  frequency.frequency = convertFromBcdToValue(&buffer[0]);
+  frequency.mode = getSignalMode(buffer[4]);
+  return frequency;
+}
+
+void setFrequency(unsigned long frequency){
+  clearAvailableBytes();
+  uint8_t data[5];
+  convertFromValueToBcd(&data[0], frequency);
+  data[4] = 0x1;
+  sendCommand(&data[0], sizeof(data));
+}

lib/FT817_NBS/FT817_NBS.h

@@ -0,0 +1,32 @@
+#ifndef FT817_NBS_H
+#define FT817_NBS_H
+#include <Arduino.h>
+#include <SoftwareSerial.h>
+//#include <Arduino.h>
+
+class FT817_NBS {
+public:
+  enum SignalMode {LSB = 0x0, USB = 0x1, CW = 0x2, CWR = 0x3, AM = 0x4, WFM = 0x6, FM = 0x8, DIG = 0xA, PKT = 0xC, UNKNOWN};
+
+private:
+  unsigned long bcdToInt(uint8_t bcd);
+  unsigned long getDevicer(int step);
+  uint8_t intToBcd(unsigned long value);
+  void convertFromValueToBcd(uint8_t *buffer, unsigned long actualValue);
+  unsigned long convertFromBcdToValue(uint8_t *buffer);
+  void clearAvailableBytes();
+  void sendCommand();
+  FT817_NBS::SignalMode getSignalMode(uint8_t numericValue);
+
+public:
+  FT817_NBS(SoftwareSerial serial);
+  struct Frequency {
+    unsigned long frequency;
+    FT817_NBS::SignalMode mode;
+  };
+  
+  FT817_NBS::Frequency getFrequency();
+  void setFrequency(unsigned long frequency);
+  void toggleAB();
+};
+#endif