Copied rfmods version of drssi code