Removed VAR_H_TEST, fixed potential bug with accelerations being screwed up when using CDAV