rt-thread-official/bsp/fh8620/platform/plat-v2/iomux.c

285 lines
6.4 KiB
C

/*
* This file is part of FH8620 BSP for RT-Thread distribution.
*
* Copyright (c) 2016 Shanghai Fullhan Microelectronics Co., Ltd.
* All rights reserved
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
* Visit http://www.fullhan.com to get contact with Fullhan.
*
* Change Logs:
* Date Author Notes
*/
#include "rtdebug.h"
#include "iomux.h"
static void fh_iomux_setmfs(Iomux_Pad *pad)
{
switch (pad->reg_type) {
case 8:
(IOMUX_PADTYPE(8)pad->reg)->bit.mfs = pad->func_sel;
break;
case 13:
(IOMUX_PADTYPE(13)pad->reg)->bit.mfs = pad->func_sel;
break;
case 20:
(IOMUX_PADTYPE(20)pad->reg)->bit.mfs = pad->func_sel;
break;
case 21:
(IOMUX_PADTYPE(21)pad->reg)->bit.mfs = pad->func_sel;
break;
default:
break;
}
}
#ifdef IOMUX_DEBUG
static int fh_iomux_getmfs(Iomux_Pad *pad)
{
int mfs;
switch (pad->reg_type) {
case 8:
mfs = (IOMUX_PADTYPE(8)pad->reg)->bit.mfs;
break;
case 13:
mfs = (IOMUX_PADTYPE(13)pad->reg)->bit.mfs;
break;
case 20:
mfs = (IOMUX_PADTYPE(20)pad->reg)->bit.mfs;
break;
case 21:
mfs = (IOMUX_PADTYPE(21)pad->reg)->bit.mfs;
break;
default:
mfs = -1;
break;
}
return mfs;
}
static void fh_iomux_print()
{
int i;
UINT32 reg;
for (i = 0; i < ARRAY_SIZE(fh81_iomux_cfg); i++) {
int curr_func;
curr_func = fh81_iomux_getmfs(iomux_obj, &iomux_obj.pads[i]);
reg = readl((UINT32)iomux_obj.pads[i].reg);
if (curr_func < 0)
rt_kprintf("\t%d\t\t%-8s(no mfs)\t0x%08x\n", i, iomux_obj.pads[i].func_name[0],
reg);
else
rt_kprintf("\t%d\t\t%-16s\t0x%08x\n", i, iomux_obj.pads[i].func_name[curr_func],
reg);
}
}
#endif
static void fh_iomux_setcur(Iomux_Pad *pad)
{
switch (pad->reg_type) {
case 5:
(IOMUX_PADTYPE(5)pad->reg)->bit.e8_e4 = pad->drv_cur;
break;
case 8:
(IOMUX_PADTYPE(8)pad->reg)->bit.e8_e4 = pad->drv_cur;
break;
case 13:
(IOMUX_PADTYPE(13)pad->reg)->bit.e4_e2 = pad->drv_cur;
break;
case 17:
(IOMUX_PADTYPE(17)pad->reg)->bit.e8_e4 = pad->drv_cur;
break;
case 20:
(IOMUX_PADTYPE(20)pad->reg)->bit.e4_e2 = pad->drv_cur;
break;
case 21:
(IOMUX_PADTYPE(21)pad->reg)->bit.e4_e2 = pad->drv_cur;
break;
default:
break;
}
}
static void fh_iomux_setpupd(Iomux_Pad *pad)
{
switch (pad->reg_type) {
case 9:
(IOMUX_PADTYPE(9)pad->reg)->bit.pu_pd = pad->pupd;
break;
case 17:
(IOMUX_PADTYPE(17)pad->reg)->bit.pu_pd = pad->pupd;
break;
case 20:
(IOMUX_PADTYPE(20)pad->reg)->bit.pu_pd = pad->pupd;
break;
case 21:
(IOMUX_PADTYPE(21)pad->reg)->bit.pu_pd = pad->pupd;
break;
default:
break;
}
}
static void fh_iomux_setrest(Iomux_Pad *pad)
{
switch (pad->reg_type) {
case 5:
(IOMUX_PADTYPE(5)pad->reg)->bit.sr = 0;
break;
case 8:
(IOMUX_PADTYPE(8)pad->reg)->bit.sr = 0;
break;
case 9:
(IOMUX_PADTYPE(9)pad->reg)->bit.ie = 1;
(IOMUX_PADTYPE(9)pad->reg)->bit.smt = 1;
break;
case 13:
(IOMUX_PADTYPE(13)pad->reg)->bit.ie = 1;
(IOMUX_PADTYPE(13)pad->reg)->bit.smt = 1;
break;
case 17:
(IOMUX_PADTYPE(17)pad->reg)->bit.sr = 0;
(IOMUX_PADTYPE(17)pad->reg)->bit.ie = 1;
(IOMUX_PADTYPE(17)pad->reg)->bit.e = 1;
(IOMUX_PADTYPE(17)pad->reg)->bit.smt = 1;
break;
case 20:
(IOMUX_PADTYPE(20)pad->reg)->bit.sr = 0;
(IOMUX_PADTYPE(20)pad->reg)->bit.ie = 1;
(IOMUX_PADTYPE(20)pad->reg)->bit.smt = 1;
break;
case 21:
(IOMUX_PADTYPE(21)pad->reg)->bit.sr = 0;
(IOMUX_PADTYPE(21)pad->reg)->bit.ie = 1;
(IOMUX_PADTYPE(21)pad->reg)->bit.smt = 1;
break;
default:
break;
}
}
static Iomux_Object iomux_obj;
extern Iomux_Pad fh_iomux_cfg[];
extern const int fh_iomux_cfg_count;
void __fh_setiomux(Iomux_Pad *pad, void *iobase)
{
UINT32 regvalue = 0;
pad->reg = &regvalue;
fh_iomux_setmfs(pad);
fh_iomux_setcur(pad);
fh_iomux_setpupd(pad);
fh_iomux_setrest(pad);
SET_REG(iobase, regvalue);
}
static UINT32 g_iomux_base;
void fh_iomux_init(UINT32 base)
{
// return;
int i;
// int test_cnt = 0;
UINT32 reg;
g_iomux_base = base;
iomux_obj.pbase = (void *)base;
// iomux_obj.vbase = (UINT32 *)rt_malloc(1024);
iomux_obj.pads = fh_iomux_cfg;
for (i = 0; i < fh_iomux_cfg_count; i++) {
#if (1)
iomux_obj.pads[i].id = i;
iomux_obj.pads[i].reg_offset = i * 4;
iomux_obj.pads[i].reg = &reg;//(UINT32 *)(iomux_obj.vbase + iomux_obj.pads[i].reg_offset);
fh_iomux_setmfs(&fh_iomux_cfg[i]);
fh_iomux_setcur(&fh_iomux_cfg[i]);
fh_iomux_setpupd(&fh_iomux_cfg[i]);
fh_iomux_setrest(&fh_iomux_cfg[i]);
SET_REG(iomux_obj.pbase + iomux_obj.pads[i].reg_offset, reg);
// *((UINT32 *)(iomux_obj.vbase + iomux_obj.pads[i].reg_offset)));
//rt_kprintf("addr: 0x%x, pmu data: 0x%x\n", iomux_obj.pbase + iomux_obj.pads[i].reg_offset, GET_REG(iomux_obj.pbase + iomux_obj.pads[i].reg_offset));
// test_cnt++;
#else
#ifdef FH_USING_JTAG
if (strncmp(fh_iomux_cfg[i].func_name[0], "JTAG", 4) == 0)
continue;
#endif
/*
if (strncmp(fh_iomux_cfg[i].func_name[1], "UART1", 5) == 0)
break;
*/
__fh_setiomux(&fh_iomux_cfg[i], (void *) base + i * 4);
#endif
}
#ifdef CONFIG_RMII
//(IOMUX_PADTYPE(17)(iomux_obj.pads[18]).reg)->bit.e = 1;
reg = GET_REG(0xf00000a4);
reg |= (1 << 13);
SET_REG(0xf00000a4, reg);
#else
//(IOMUX_PADTYPE(17)(iomux_obj.pads[18]).reg)->bit.e = 0;
reg = GET_REG(0xf00000a4);
reg &= ~(1 << 13);
SET_REG(0xf00000a4, reg);
#endif
#ifdef IOMUX_DEBUG
fh_iomux_print(iomux_obj);
#endif
//rt_free(iomux_obj.vbase);
//iomux_obj.vbase = 0;
}
void fh_iomux_pin_switch(int pin_num, int func_num)
{
RT_ASSERT(pin_num < fh_iomux_cfg_count);
__fh_setiomux(&fh_iomux_cfg[pin_num], (void *)g_iomux_base + pin_num * 4);
/*
fh_iomux_cfg[pin_num].func_sel = func_num;
fh_iomux_setmfs(&fh_iomux_cfg[pin_num]);
SET_REG(iomux_obj.pbase + iomux_obj.pads[pin_num].reg_offset, *((UINT32 *)(iomux_obj.vbase + iomux_obj.pads[pin_num].reg_offset)));
*/
}