Chamber Manager Board 제작 #9 (Chamber Manager 뼈대 제작)

【 3D 프린터 챔버 만들기 】

[ Control Board 제작 #9 : Chamber Manager 뼈대 제작 ]

□ 필요 모듈

 : ServoTimer2

 : DHT

 : Door Control

 : Fan Control

 : Temperature Control

[ ChamberManager.ino ]

#include <ServoTimer2.h>
#include <DHT.h>
#include "Door.h"
#include "FANControl.h"
#include "DeviceCMD.h"
#include "TempControl.h"
 
#define D0                  0
#define D1                  1
#define D2                  2
#define D3                  3
#define D4                  4
#define D5                  5
#define D6                  6
#define D7                  7
#define D8                  8
#define D9                  9
#define D10                 10
#define D11                 11
#define D12                 12
#define D13                 13
 
#define TEMP_SENSOR_DHT22   D4
#define DHTTYPE             DHT22
 
#define SERVO_FILTER        D6
#define SERVO_VENTIL        D5
#define FAN1_RPM_READ       D7
#define FAN2_RPM_READ       D8
// Pins 9 and 10 controlled by timer 1
#define FAN1_RPM_WRITE      D9
#define FAN2_RPM_WRITE      D10
 
unsigned long g_ulMils = 0;
 
DeviceCMD CMDParser;
 
Door g_DoorFilter;
Door g_DoorVentil;
 
FANControl g_FanVentil;
FANControl g_FanFilter;
 
DHT g_DHT(TEMP_SENSOR_DHT22, DHTTYPE);
 
TempControl g_TempControl;
 
float g_fAmbentTemp = 0;
float g_fHumidity = 0;
float g_fAmbientTempTarget = 23.0;
float g_fAmbientTempDeviation = 1.0;
 
TEMP_CONTROL_MODE g_TempCtrlMode = ONOFF;
 
void setup() {
  // LCD setup
  Serial.begin(115200);
 
  // Ventilation degree : Close 10, Open 135 (0, 140)
  // Filter degree      : Close 47, Open 137
  g_DoorVentil.SetRange(SERVO_POS_MAX, SERVO_POS_MIN);
  g_DoorVentil.Attach(SERVO_VENTIL);
  g_DoorFilter.SetRange(SERVO_POS_MAX, SERVO_POS_MIN);
  g_DoorFilter.Attach(SERVO_FILTER);
  
  // Flap door open when power on
  g_DoorFilter.Open();
  g_DoorVentil.Open();
 
  // Fans Control
  FANControl::InitFanTimer();
  g_FanVentil.Attach(FAN1_RPM_WRITE, FAN1_RPM_READ);
  g_FanFilter.Attach(FAN2_RPM_WRITE, FAN2_RPM_READ);
 
  g_FanVentil.SetSpeed(100);
  g_FanFilter.SetSpeed(100);
 
  // Temperature control
  g_DHT.begin();
  delay(2000);
  g_fAmbentTemp = g_DHT.readTemperature();
  g_fHumidity = g_DHT.readHumidity();
 
  if(isnan(g_fAmbentTemp) || isnan(g_fHumidity))
  {
    Serial.println(F("ERROR Failed to read from DHT sensor!"));
    g_fAmbentTemp = 25;
    g_fHumidity = 50;
  }
 
  Serial.println(F("OK Device ready."));
 
  g_ulMils = millis();
}
 
bool Execute(CMD cmd)
{
 
    return false;
}
 
void loop()
{
  unsigned long m = millis();
 
  // Check Serial Command
  while(Serial.available()>0)
  {
    CMD_QUEUE_STATUS ret = CMDParser.QueueBuffer(Serial.read());
 
    if(ret == FALSE) Serial.println(F("ERROR Command buffering error."));
    if(ret == DECODED)
      if(!Execute(CMDParser.GetCMD())) Serial.println(F("ERROR Command excution error."));
  }
 
  // Refresh status
  Door::Refresh();
  FANControl::Refresh();
 
  if((m-g_ulMils)>500)
  {
    g_ulMils = m;
 
    int angle = g_TempControl.CheckTemp(g_DHT.readTemperature());
    if(angle>=0)
    {
      g_DoorVentil.SetAngle(angle);
      g_DoorFilter.SetAngle(angle);
    }
 
  }
 
}