Fixing many small bugs and disabling drift_correction temporarily because it is buggy. DATA packets get through but NO_ACK causes a bug.