1 /*
2 * Copyright (c) 2006-2018, RT-Thread Development Team
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 *
6 * Change Logs:
7 * Date Author Notes
8 * 2021-04-11 RiceChen the first version
9 *
10 */
11
12 #include <rthw.h>
13 #include <rtdevice.h>
14 #include "board.h"
15
16 #include "mmu.h"
17 #include "ioremap.h"
18 #include "fsl_iomuxc.h"
19 #include "drv_common.h"
20
imx6ull_get_periph_vaddr(rt_uint32_t paddr)21 void *imx6ull_get_periph_vaddr(rt_uint32_t paddr)
22 {
23 return rt_ioremap((void *)paddr, sizeof(sizeof(rt_uint32_t)));
24 }
25
imx6ull_get_periph_paddr(rt_uint32_t vaddr)26 void *imx6ull_get_periph_paddr(rt_uint32_t vaddr)
27 {
28 return rt_kmem_v2p((void *)vaddr);
29 }
30
imx6ull_gpio_init(const struct imx6ull_iomuxc * gpio)31 void imx6ull_gpio_init(const struct imx6ull_iomuxc *gpio)
32 {
33 rt_uint32_t mux_reg_vaddr = 0;
34 rt_uint32_t input_reg_vaddr = 0;
35 rt_uint32_t config_reg_vaddr = 0;
36
37 mux_reg_vaddr = (rt_uint32_t)(gpio->muxRegister ? (rt_uint32_t)imx6ull_get_periph_vaddr(gpio->muxRegister) : gpio->muxRegister);
38 input_reg_vaddr = (rt_uint32_t)(gpio->inputRegister ? (rt_uint32_t)imx6ull_get_periph_vaddr(gpio->inputRegister) : gpio->inputRegister);
39 config_reg_vaddr = (rt_uint32_t)(gpio->configRegister ? (rt_uint32_t)imx6ull_get_periph_vaddr(gpio->configRegister) : gpio->configRegister);
40
41 IOMUXC_SetPinMux(mux_reg_vaddr, gpio->muxMode, input_reg_vaddr, gpio->inputDaisy, config_reg_vaddr, gpio->inputOnfield);
42 IOMUXC_SetPinConfig(mux_reg_vaddr, gpio->muxMode, input_reg_vaddr, gpio->inputDaisy, config_reg_vaddr, gpio->configValue);
43 }
44