GPIO implemented; Think it's right, need to test tonightish