Refactored to more easily support Papilio and Olimex MOD VGA

Change-Id: I4a3f3ac7690c2bddebdfe0f4634c848301b1d222