Fixing main2 IO problems

Changed to wiring pi instead of custom io driver.