   create_sensor(sensor_count, ANALOG_PIN, TYPE_ANALOG, &analog_sensor);
   sensors[sensor_count++] = analog_sensor;
 
+  // Create one wire temperature sensor
   TemperatureSensor one_wire_sensor;
   create_sensor(sensor_count, ONE_WIRE_PIN, TYPE_ONE_WIRE, &one_wire_sensor);
   sensors[sensor_count++] = one_wire_sensor;
 
+  // Create I2C temperature sensors
   TemperatureSensor i2c_sensor0;
   create_sensor(sensor_count, TMP102_ADDR_0, TYPE_I2C, &i2c_sensor0);
   sensors[sensor_count++] = i2c_sensor0;
-}
-
-void loop()
+
+  // Set heater output pin
+  pinMode(HEATER_PIN, OUTPUT); 
+}
+
+void loop(void)
 {
   TemperatureSensor* sensor;
   for(uint32_t c = 0; c < SENSOR_COUNT; c++) {

#define MAX_SAMPLE_RATE 10
#define MAX_SAMPLE_COUNT 10
#define MAX_DELTA 0.5

typedef struct one_wire_data {
  OneWire one_wire;

  }
}

void setup(void)
{  
  nh.initNode();
  nh.advertise(pub_temp);
  nh.advertise(pub_count);
  nh.subscribe(sub_temp);
  nh.subscribe(sub_count);
  nh.subscribe(sub_heater);
  
  uint32_t sensor_count = 0;
  // Create analog temperature sensor
