1 /* 2 * GPIO access for tasks. 3 * 4 * Copyright (C) 2016 Paul Boddie <paul@boddie.org.uk> 5 * 6 * This program is free software: you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation, either version 3 of the License, or 9 * (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program. If not, see <http://www.gnu.org/licenses/>. 18 */ 19 20 #include "board.h" 21 #include "mips.h" 22 #include "cpu.h" 23 #include "paging.h" 24 #include "memory.h" 25 #include "task_gpio.h" 26 27 void task_gpio_init(unsigned short task) 28 { 29 /* Map the I/O region to the task. */ 30 31 init_page_table(STAGE2_PAGE_TABLE, 32 TASK_GPIO_BASE, 33 GPIO_BASE, 34 page_size(GPIO_REGION_SIZE), TLB_WRITE, task); 35 } 36 37 inline void task_gpio_set_pin(unsigned short pin) 38 { 39 TASK_REG_GPIO_PXDATS(pin / 32) = (1 << (pin % 32)); 40 } 41 42 inline void task_gpio_clear_pin(unsigned short pin) 43 { 44 TASK_REG_GPIO_PXDATS(pin / 32) = (1 << (pin % 32)); 45 } 46 47 inline int task_gpio_get_pin(unsigned short pin) 48 { 49 return TASK_REG_GPIO_PXPIN(pin / 32) & (1 << (pin % 32)); 50 }