Combining code together. Nightmare bug

[moskovskiy82]

Built a node which would combine together a DHT22 + MQ2 + RGB LED Strip on mosfets + IR Aircond control.
Problem i am facing
SENSORS+ IR Aircond code works Github HVAC and Sensor
Comiled sketch size 16468 bytes

SENSORS+RGB code works Github RGB and Sensor
Comiled sketch size 18910 bytes

By working i mean i ran them for half an hour (this was to rule out my main problem of the board - power supply as it's a 7805 converter which is quite hot) and during these time i was sending commands (strip lit up or send aircond temp + fan speed e.t.c). DHT and MQ2 values were reported as they should - every 60 seconds.

But when i combine all the code together. Everything works - but only humidity is being reported for sensors every 60 seconds (no temperature from DHT22 or air quality from MQ2 are being reported). I have tried changing the code, different variation and all i could see that these values report "nan". Have already broke my head on this - so desperately need a helping hand.
This is the code combined. What can it be? Just a tiny extra load on the chip and more power drawn which sets 7805 mad? Or some incompatability in the code? Memory problems?
Sketch uses 18744 bytes (61%) of program storage space. Maximum is 30720 bytes.
Global variables use 1391 bytes (67%) of dynamic memory, leaving 657 bytes for local variables. Maximum is 2048 bytes.
Any push in the direction of fixing it up is much appreciated

#define SN "Bedroom"
#define SV "2.1"

/*
#define MODE_AUTO   1
#define MODE_HEAT   2
#define MODE_COOL   3
#define MODE_DRY    4
#define MODE_FAN    5
#define MODE_MAINT  6

#define FAN_AUTO    0
#define FAN_1       1
#define FAN_2       2
#define FAN_3       3
#define FAN_4       4
#define FAN_5       5

#define VDIR_AUTO   0
#define VDIR_MANUAL 0
#define VDIR_SWING  1
#define VDIR_UP     2
#define VDIR_MUP    3
#define VDIR_MIDDLE 4
#define VDIR_MDOWN  5
#define VDIR_DOWN   6

#define HDIR_AUTO   0
#define HDIR_MANUAL 0
#define HDIR_SWING  1
#define HDIR_MIDDLE 2
#define HDIR_LEFT   3
#define HDIR_MLEFT  4
#define HDIR_MRIGHT 5
#define HDIR_RIGHT  6
 
*/
 
#define MY_NODE_ID 31

//Disable blinking
#define MY_DEFAULT_ERR_LED A10
#define MY_DEFAULT_TX_LED A10
#define MY_DEFAULT_RX_LED A10

#define MY_RADIO_NRF24
#define MY_RF24_CE_PIN 8

#include <SPI.h>
#include <MySensors.h>
#include <DHT.h> 
#include <math.h>
#include <Wire.h>
#include <FujitsuHeatpumpIR.h>

//Define connections
#define CHILD_ID_HVAC 0
#define CHILD_ID_LIGHT 1
#define CHILD_ID_HUM 2
#define CHILD_ID_TEMP 3
#define CHILD_ID_MQ 4

#define DHT_PIN 7
const int MQ_Pin = A3;
DHT dht;

//MQ+DHT
long MQ_Millis = 0;
long MQ_interval = 60000;
long DHT_Millis = 0;
long DHT_interval = 60000;
MyMessage msgHum(CHILD_ID_HUM, V_HUM);
MyMessage msgTemp(CHILD_ID_TEMP, V_TEMP);
MyMessage msgMQ(CHILD_ID_MQ, V_LEVEL);

//HVAC
//Some global variables to hold the states
int POWER_STATE;
int TEMP_STATE;
int FAN_STATE;
int MODE_STATE;
int VDIR_STATE;
int HDIR_STATE;
String HA_MODE_STATE = "Off";
String HA_FAN_STATE = "Min";

IRSenderPWM irSender(3);       // IR led on Arduino digital pin 3, using Arduino PWM
HeatpumpIR *heatpumpIR = new FujitsuHeatpumpIR();

MyMessage msgHVACSetPointC(CHILD_ID_HVAC, V_HVAC_SETPOINT_COOL);
MyMessage msgHVACSpeed(CHILD_ID_HVAC, V_HVAC_SPEED);
MyMessage msgHVACFlowState(CHILD_ID_HVAC, V_HVAC_FLOW_STATE);

bool initialValueSent = false;

//RGB VARS AND PINS
#define REDPIN 6
#define GREENPIN 5
#define BLUEPIN 9
MyMessage lightMsg(CHILD_ID_LIGHT, V_LIGHT);
MyMessage rgbMsg(CHILD_ID_LIGHT, V_RGB);
MyMessage dimmerMsg(CHILD_ID_LIGHT, V_DIMMER);
//Global variables
byte red = 255;
byte green = 255;
byte blue = 255;
byte r0 = 255;
byte g0 = 255;
byte b0 = 255;
char rgbstring[] = "ffffff";

int on_off_status = 0;
int dimmerlevel = 100;
int fadespeed = 0;



void before() 
{
  dht.setup(DHT_PIN);
  loadState(CHILD_ID_HVAC);
}
void setup()
{ 
Serial.begin(115200);
pinMode(REDPIN, OUTPUT);
pinMode(GREENPIN, OUTPUT);
pinMode(BLUEPIN, OUTPUT);
}
void presentation()  
{ 
  sendSketchInfo(SN, SV);
  present(CHILD_ID_HUM, S_HUM);
  present(CHILD_ID_TEMP, S_TEMP);
  present(CHILD_ID_MQ, S_AIR_QUALITY);
  present(CHILD_ID_LIGHT, S_RGB_LIGHT);
  present(CHILD_ID_HVAC, S_HVAC, "");
  
}

void loop()
{
unsigned long DHT_Current_Millis = millis();
if((unsigned long)(DHT_Current_Millis - DHT_Millis) >= DHT_interval)
  {
    DHT_Millis = DHT_Current_Millis; 
    delay(dht.getMinimumSamplingPeriod());
    float temperature = dht.getTemperature();
    float humidity = dht.getHumidity();
    if (isnan(temperature)) 
      {Serial.println("Failed reading temperature from DHT");}
    if (isnan(humidity)) 
      {Serial.println("Failed reading humidity from DHT");}
    else 
    {
      send(msgTemp.set(temperature, 1));
      send(msgHum.set(humidity, 1));
      Serial.print("T: ");
      Serial.println(temperature);
      Serial.print("H: ");
      Serial.println(humidity);
    }
  }

unsigned long MQ_Current_Millis = millis();
if((unsigned long)(MQ_Current_Millis - MQ_Millis) >= MQ_interval)
  {
    MQ_Millis = MQ_Current_Millis; 
    float mq_reading = analogRead(MQ_Pin);
    if (isnan(mq_reading)) 
      { Serial.println("Failed mq_reading"); } 
    else 
    {
    send(msgMQ.set(mq_reading, 1));
    Serial.print("MQ: ");
    Serial.println(mq_reading);
    }
  }
  if (!initialValueSent) 
  {
    Serial.println("Sending initial values");
    POWER_STATE = 0;
    MODE_STATE = MODE_AUTO;
    FAN_STATE = 1;
    TEMP_STATE = 24;
    sendHeatpumpCommand();
    sendNewStateToGateway();
    
    request(CHILD_ID_HVAC, V_HVAC_SETPOINT_COOL);
    wait(3000, C_SET, V_HVAC_SETPOINT_COOL);
    request(CHILD_ID_HVAC, V_HVAC_SPEED);
    wait(3000, C_SET, V_HVAC_SPEED);
    request(CHILD_ID_HVAC, V_HVAC_FLOW_STATE);
    wait(3000, C_SET, V_HVAC_FLOW_STATE);
    //initialValueSent = true;
  }
  static bool first_message_sent = false;
  if ( first_message_sent == false ) 
  {
    Serial.println( "Sending initial state..." );
    set_hw_status();
    send_status();
    first_message_sent = true;
  }
}

void receive(const MyMessage &message) {
  if (message.isAck()) {
     Serial.println("This is an ack from gateway");
     //return;
  }

  Serial.print("Incoming message for: ");
  Serial.print(message.sensor);
  int val; //RGB VAR  
  String recvData = message.data;
  recvData.trim();

  Serial.print(", New status: ");
  Serial.println(recvData);
  switch (message.type) 
  {
    case V_HVAC_SPEED:
     Serial.println("V_HVAC_SPEED");
     if(recvData.equalsIgnoreCase("auto")) 
	{
	 FAN_STATE = 0;
	 HA_FAN_STATE = "Auto";
	}
      else if(recvData.equalsIgnoreCase("min")) 
	{
         FAN_STATE = 1;
         HA_FAN_STATE = "Min";
         }
      else if(recvData.equalsIgnoreCase("normal")) 
	{
         FAN_STATE = 2;
         HA_FAN_STATE = "Normal";
        }
      else if(recvData.equalsIgnoreCase("max")) 
	{
         FAN_STATE = 3;
         HA_FAN_STATE = "Max";
        }
    break;
    case V_HVAC_SETPOINT_COOL:
      Serial.println("V_HVAC_SETPOINT_COOL");
      TEMP_STATE = message.getFloat();
      Serial.println(TEMP_STATE);
    break;
    case V_HVAC_FLOW_STATE:
      Serial.println("V_HVAC_FLOW_STATE");
      if (recvData.equalsIgnoreCase("coolon")) 
	{
         POWER_STATE = 1;
         MODE_STATE = MODE_COOL;
         HA_MODE_STATE = "CoolOn";
        }
      else if (recvData.equalsIgnoreCase("heaton")) 
	{
         POWER_STATE = 1;
         MODE_STATE = MODE_HEAT;
         HA_MODE_STATE = "HeatOn";
        }
      else if (recvData.equalsIgnoreCase("autochangeover")) 
       {
         POWER_STATE = 1;
         MODE_STATE = MODE_AUTO;
         HA_MODE_STATE = "AutoChangeOver";
        }
      else if (recvData.equalsIgnoreCase("off"))
	{
         POWER_STATE = 0;
         HA_MODE_STATE = "Off";
        }
      initialValueSent = true;
    break;
  case V_RGB:
     {
     Serial.println( "V_RGB command: " );
     Serial.println(message.data);
     long number = (long) strtol( message.data, NULL, 16);
     // Save old value
     strcpy(rgbstring, message.data);
     // Split it up into r, g, b values
     red = number >> 16;
     green = number >> 8 & 0xFF;
     blue = number & 0xFF;
     send_status();
     set_hw_status();
    }
  break;
  case V_LIGHT:
    {
     Serial.println( "V_LIGHT command: " );
     Serial.println(message.data);
     val = atoi(message.data);
     if (val == 0 or val == 1) 
	{
         on_off_status = val;
         send_status();
         set_hw_status();
        }
    }
  break;
  case V_DIMMER: 
    {
    Serial.print( "V_DIMMER command: " );
    Serial.println(message.data);
    val = atoi(message.data);
    if (val >= 0 and val <=100) 
	{
	  dimmerlevel = val;
	  send_status();
	  set_hw_status();
	}
    }
  break;
  case V_VAR1:
    {
    Serial.print( "V_VAR1 command: " );
    Serial.println(message.data);
    val = atoi(message.data);
    if (val >= 0 and val <= 2000) 
	{
	  fadespeed = val;
	}
    }
  break;
  }  
  
  sendHeatpumpCommand();
  sendNewStateToGateway();
}

void sendNewStateToGateway() {
  send(msgHVACSetPointC.set(TEMP_STATE));
  wait(1000, C_SET, V_HVAC_SETPOINT_COOL);
  char fan_state[HA_FAN_STATE.length() + 1];
  HA_FAN_STATE.toCharArray(fan_state, HA_FAN_STATE.length() + 1);
  send(msgHVACSpeed.set(fan_state));
  wait(1000, C_SET, V_HVAC_SPEED);
  char mode_state[HA_MODE_STATE.length() + 1];
  HA_MODE_STATE.toCharArray(mode_state, HA_MODE_STATE.length() + 1);
  send(msgHVACFlowState.set(mode_state));
  wait(1000, C_SET, V_HVAC_FLOW_STATE);
}

void sendHeatpumpCommand() {
  Serial.println("Power = " + (String)POWER_STATE);
  Serial.println("Mode = " + (String)MODE_STATE);
  Serial.println("Fan = " + (String)FAN_STATE);
  Serial.println("Temp = " + (String)TEMP_STATE);

  heatpumpIR->send(irSender, POWER_STATE, MODE_STATE, FAN_STATE, TEMP_STATE, VDIR_AUTO, HDIR_AUTO);
}

void set_rgb(int r, int g, int b) {
  analogWrite(REDPIN, r);
  analogWrite(GREENPIN, g);
  analogWrite(BLUEPIN, b);
}

void set_hw_status() 
{
  int r = on_off_status * (int)(red * dimmerlevel/100.0);
  int g = on_off_status * (int)(green * dimmerlevel/100.0);
  int b = on_off_status * (int)(blue * dimmerlevel/100.0);
  if (fadespeed >0) 
  {
    float dr = (r - r0) / float(fadespeed);
    float db = (b - b0) / float(fadespeed);
    float dg = (g - g0) / float(fadespeed);
    for (int x = 0;  x < fadespeed; x++) 
		{
		  set_rgb(r0 + dr*x, g0 + dg*x, b0 + db*x);
		  delay(100);
		}
  }
  set_rgb(r, g, b);
  r0 = r;
  b0 = b;
  g0 = g;
}

void send_status() 
{
  send(rgbMsg.set(rgbstring));
  send(lightMsg.set(on_off_status));
  send(dimmerMsg.set(dimmerlevel));
}

[moskovskiy82]

Well guess it was a bug. Removed some of the include libs. Deleted serial output and ... it worked. Now one more thing to solve but i guess that's another story