First modification to Raspi rev2 support. This commit compiles in rev2 but crashes while running!