gpio.c (1215B)
1 /* gpio.c 2 * 3 * Copyright 2014 Brian Swetland <swetland@frotz.net> 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 */ 17 18 #include <fw/io.h> 19 #include <fw/lib.h> 20 #include <arch/hardware.h> 21 22 #define GPIO_OFF(n) ((n >> 5) << 2) 23 #define GPIO_BIT(n) (1 << ((n) & 31)) 24 25 void gpio_cfg_dir(unsigned n, unsigned dir) { 26 u32 r = GPIO0_DIR + GPIO_OFF(n); 27 if (dir == GPIO_CFG_OUT) { 28 writel(readl(r) | GPIO_BIT(n), r); 29 } else { 30 writel(readl(r) & (~GPIO_BIT(n)), r); 31 } 32 } 33 34 void gpio_set(unsigned n) { 35 writeb(1, GPIO_BYTE(n)); 36 } 37 38 void gpio_clr(unsigned n) { 39 writeb(0, GPIO_BYTE(n)); 40 } 41 42 int gpio_rd(unsigned n) { 43 return readb(GPIO_BYTE(n)); 44 } 45 46 void gpio_wr(unsigned n, unsigned v) { 47 writeb(!!v, GPIO_BYTE(n)); 48 }