Added Wait_For, START_SENSOR/STOP_SENSOR, changed Heartbeat-Timing