Add helper to toggle single pin, use in test program