NFC: Make polling mode switchable (2/3)

This needs a lot of todo! Very hacky!

Change-Id: I0f526185897ce6075ca7b34a71733e6a128cb286