Added some gpio logic, still need reading implemented