18c2ecf20Sopenharmony_ci/* 28c2ecf20Sopenharmony_ci * General Purpose functions for the global management of the 38c2ecf20Sopenharmony_ci * 8260 Communication Processor Module. 48c2ecf20Sopenharmony_ci * Copyright (c) 1999-2001 Dan Malek <dan@embeddedalley.com> 58c2ecf20Sopenharmony_ci * Copyright (c) 2000 MontaVista Software, Inc (source@mvista.com) 68c2ecf20Sopenharmony_ci * 2.3.99 Updates 78c2ecf20Sopenharmony_ci * 88c2ecf20Sopenharmony_ci * 2006 (c) MontaVista Software, Inc. 98c2ecf20Sopenharmony_ci * Vitaly Bordug <vbordug@ru.mvista.com> 108c2ecf20Sopenharmony_ci * Merged to arch/powerpc from arch/ppc/syslib/cpm2_common.c 118c2ecf20Sopenharmony_ci * 128c2ecf20Sopenharmony_ci * This file is licensed under the terms of the GNU General Public License 138c2ecf20Sopenharmony_ci * version 2. This program is licensed "as is" without any warranty of any 148c2ecf20Sopenharmony_ci * kind, whether express or implied. 158c2ecf20Sopenharmony_ci */ 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci/* 188c2ecf20Sopenharmony_ci * 198c2ecf20Sopenharmony_ci * In addition to the individual control of the communication 208c2ecf20Sopenharmony_ci * channels, there are a few functions that globally affect the 218c2ecf20Sopenharmony_ci * communication processor. 228c2ecf20Sopenharmony_ci * 238c2ecf20Sopenharmony_ci * Buffer descriptors must be allocated from the dual ported memory 248c2ecf20Sopenharmony_ci * space. The allocator for that is here. When the communication 258c2ecf20Sopenharmony_ci * process is reset, we reclaim the memory available. There is 268c2ecf20Sopenharmony_ci * currently no deallocator for this memory. 278c2ecf20Sopenharmony_ci */ 288c2ecf20Sopenharmony_ci#include <linux/errno.h> 298c2ecf20Sopenharmony_ci#include <linux/sched.h> 308c2ecf20Sopenharmony_ci#include <linux/kernel.h> 318c2ecf20Sopenharmony_ci#include <linux/param.h> 328c2ecf20Sopenharmony_ci#include <linux/string.h> 338c2ecf20Sopenharmony_ci#include <linux/mm.h> 348c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 358c2ecf20Sopenharmony_ci#include <linux/module.h> 368c2ecf20Sopenharmony_ci#include <linux/of.h> 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci#include <asm/io.h> 398c2ecf20Sopenharmony_ci#include <asm/irq.h> 408c2ecf20Sopenharmony_ci#include <asm/mpc8260.h> 418c2ecf20Sopenharmony_ci#include <asm/page.h> 428c2ecf20Sopenharmony_ci#include <asm/cpm2.h> 438c2ecf20Sopenharmony_ci#include <asm/rheap.h> 448c2ecf20Sopenharmony_ci#include <asm/fs_pd.h> 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci#include <sysdev/fsl_soc.h> 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_cicpm_cpm2_t __iomem *cpmp; /* Pointer to comm processor space */ 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_ci/* We allocate this here because it is used almost exclusively for 518c2ecf20Sopenharmony_ci * the communication processor devices. 528c2ecf20Sopenharmony_ci */ 538c2ecf20Sopenharmony_cicpm2_map_t __iomem *cpm2_immr; 548c2ecf20Sopenharmony_ciEXPORT_SYMBOL(cpm2_immr); 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci#define CPM_MAP_SIZE (0x40000) /* 256k - the PQ3 reserve this amount 578c2ecf20Sopenharmony_ci of space for CPM as it is larger 588c2ecf20Sopenharmony_ci than on PQ2 */ 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_civoid __init cpm2_reset(void) 618c2ecf20Sopenharmony_ci{ 628c2ecf20Sopenharmony_ci#ifdef CONFIG_PPC_85xx 638c2ecf20Sopenharmony_ci cpm2_immr = ioremap(get_immrbase() + 0x80000, CPM_MAP_SIZE); 648c2ecf20Sopenharmony_ci#else 658c2ecf20Sopenharmony_ci cpm2_immr = ioremap(get_immrbase(), CPM_MAP_SIZE); 668c2ecf20Sopenharmony_ci#endif 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci /* Tell everyone where the comm processor resides. 698c2ecf20Sopenharmony_ci */ 708c2ecf20Sopenharmony_ci cpmp = &cpm2_immr->im_cpm; 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci#ifndef CONFIG_PPC_EARLY_DEBUG_CPM 738c2ecf20Sopenharmony_ci /* Reset the CPM. 748c2ecf20Sopenharmony_ci */ 758c2ecf20Sopenharmony_ci cpm_command(CPM_CR_RST, 0); 768c2ecf20Sopenharmony_ci#endif 778c2ecf20Sopenharmony_ci} 788c2ecf20Sopenharmony_ci 798c2ecf20Sopenharmony_cistatic DEFINE_SPINLOCK(cmd_lock); 808c2ecf20Sopenharmony_ci 818c2ecf20Sopenharmony_ci#define MAX_CR_CMD_LOOPS 10000 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ciint cpm_command(u32 command, u8 opcode) 848c2ecf20Sopenharmony_ci{ 858c2ecf20Sopenharmony_ci int i, ret; 868c2ecf20Sopenharmony_ci unsigned long flags; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci spin_lock_irqsave(&cmd_lock, flags); 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci ret = 0; 918c2ecf20Sopenharmony_ci out_be32(&cpmp->cp_cpcr, command | opcode | CPM_CR_FLG); 928c2ecf20Sopenharmony_ci for (i = 0; i < MAX_CR_CMD_LOOPS; i++) 938c2ecf20Sopenharmony_ci if ((in_be32(&cpmp->cp_cpcr) & CPM_CR_FLG) == 0) 948c2ecf20Sopenharmony_ci goto out; 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ci printk(KERN_ERR "%s(): Not able to issue CPM command\n", __func__); 978c2ecf20Sopenharmony_ci ret = -EIO; 988c2ecf20Sopenharmony_ciout: 998c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&cmd_lock, flags); 1008c2ecf20Sopenharmony_ci return ret; 1018c2ecf20Sopenharmony_ci} 1028c2ecf20Sopenharmony_ciEXPORT_SYMBOL(cpm_command); 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_ci/* Set a baud rate generator. This needs lots of work. There are 1058c2ecf20Sopenharmony_ci * eight BRGs, which can be connected to the CPM channels or output 1068c2ecf20Sopenharmony_ci * as clocks. The BRGs are in two different block of internal 1078c2ecf20Sopenharmony_ci * memory mapped space. 1088c2ecf20Sopenharmony_ci * The baud rate clock is the system clock divided by something. 1098c2ecf20Sopenharmony_ci * It was set up long ago during the initial boot phase and is 1108c2ecf20Sopenharmony_ci * is given to us. 1118c2ecf20Sopenharmony_ci * Baud rate clocks are zero-based in the driver code (as that maps 1128c2ecf20Sopenharmony_ci * to port numbers). Documentation uses 1-based numbering. 1138c2ecf20Sopenharmony_ci */ 1148c2ecf20Sopenharmony_civoid __cpm2_setbrg(uint brg, uint rate, uint clk, int div16, int src) 1158c2ecf20Sopenharmony_ci{ 1168c2ecf20Sopenharmony_ci u32 __iomem *bp; 1178c2ecf20Sopenharmony_ci u32 val; 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci /* This is good enough to get SMCs running..... 1208c2ecf20Sopenharmony_ci */ 1218c2ecf20Sopenharmony_ci if (brg < 4) { 1228c2ecf20Sopenharmony_ci bp = cpm2_map_size(im_brgc1, 16); 1238c2ecf20Sopenharmony_ci } else { 1248c2ecf20Sopenharmony_ci bp = cpm2_map_size(im_brgc5, 16); 1258c2ecf20Sopenharmony_ci brg -= 4; 1268c2ecf20Sopenharmony_ci } 1278c2ecf20Sopenharmony_ci bp += brg; 1288c2ecf20Sopenharmony_ci /* Round the clock divider to the nearest integer. */ 1298c2ecf20Sopenharmony_ci val = (((clk * 2 / rate) - 1) & ~1) | CPM_BRG_EN | src; 1308c2ecf20Sopenharmony_ci if (div16) 1318c2ecf20Sopenharmony_ci val |= CPM_BRG_DIV16; 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci out_be32(bp, val); 1348c2ecf20Sopenharmony_ci cpm2_unmap(bp); 1358c2ecf20Sopenharmony_ci} 1368c2ecf20Sopenharmony_ciEXPORT_SYMBOL(__cpm2_setbrg); 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_ciint cpm2_clk_setup(enum cpm_clk_target target, int clock, int mode) 1398c2ecf20Sopenharmony_ci{ 1408c2ecf20Sopenharmony_ci int ret = 0; 1418c2ecf20Sopenharmony_ci int shift; 1428c2ecf20Sopenharmony_ci int i, bits = 0; 1438c2ecf20Sopenharmony_ci cpmux_t __iomem *im_cpmux; 1448c2ecf20Sopenharmony_ci u32 __iomem *reg; 1458c2ecf20Sopenharmony_ci u32 mask = 7; 1468c2ecf20Sopenharmony_ci 1478c2ecf20Sopenharmony_ci u8 clk_map[][3] = { 1488c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_BRG5, 0}, 1498c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_BRG6, 1}, 1508c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_BRG7, 2}, 1518c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_BRG8, 3}, 1528c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_CLK9, 4}, 1538c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_CLK10, 5}, 1548c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_CLK11, 6}, 1558c2ecf20Sopenharmony_ci {CPM_CLK_FCC1, CPM_CLK12, 7}, 1568c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_BRG5, 0}, 1578c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_BRG6, 1}, 1588c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_BRG7, 2}, 1598c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_BRG8, 3}, 1608c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_CLK13, 4}, 1618c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_CLK14, 5}, 1628c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_CLK15, 6}, 1638c2ecf20Sopenharmony_ci {CPM_CLK_FCC2, CPM_CLK16, 7}, 1648c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_BRG5, 0}, 1658c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_BRG6, 1}, 1668c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_BRG7, 2}, 1678c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_BRG8, 3}, 1688c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_CLK13, 4}, 1698c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_CLK14, 5}, 1708c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_CLK15, 6}, 1718c2ecf20Sopenharmony_ci {CPM_CLK_FCC3, CPM_CLK16, 7}, 1728c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_BRG1, 0}, 1738c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_BRG2, 1}, 1748c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_BRG3, 2}, 1758c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_BRG4, 3}, 1768c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_CLK11, 4}, 1778c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_CLK12, 5}, 1788c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_CLK3, 6}, 1798c2ecf20Sopenharmony_ci {CPM_CLK_SCC1, CPM_CLK4, 7}, 1808c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_BRG1, 0}, 1818c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_BRG2, 1}, 1828c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_BRG3, 2}, 1838c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_BRG4, 3}, 1848c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_CLK11, 4}, 1858c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_CLK12, 5}, 1868c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_CLK3, 6}, 1878c2ecf20Sopenharmony_ci {CPM_CLK_SCC2, CPM_CLK4, 7}, 1888c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_BRG1, 0}, 1898c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_BRG2, 1}, 1908c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_BRG3, 2}, 1918c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_BRG4, 3}, 1928c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_CLK5, 4}, 1938c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_CLK6, 5}, 1948c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_CLK7, 6}, 1958c2ecf20Sopenharmony_ci {CPM_CLK_SCC3, CPM_CLK8, 7}, 1968c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_BRG1, 0}, 1978c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_BRG2, 1}, 1988c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_BRG3, 2}, 1998c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_BRG4, 3}, 2008c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_CLK5, 4}, 2018c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_CLK6, 5}, 2028c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_CLK7, 6}, 2038c2ecf20Sopenharmony_ci {CPM_CLK_SCC4, CPM_CLK8, 7}, 2048c2ecf20Sopenharmony_ci }; 2058c2ecf20Sopenharmony_ci 2068c2ecf20Sopenharmony_ci im_cpmux = cpm2_map(im_cpmux); 2078c2ecf20Sopenharmony_ci 2088c2ecf20Sopenharmony_ci switch (target) { 2098c2ecf20Sopenharmony_ci case CPM_CLK_SCC1: 2108c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_scr; 2118c2ecf20Sopenharmony_ci shift = 24; 2128c2ecf20Sopenharmony_ci break; 2138c2ecf20Sopenharmony_ci case CPM_CLK_SCC2: 2148c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_scr; 2158c2ecf20Sopenharmony_ci shift = 16; 2168c2ecf20Sopenharmony_ci break; 2178c2ecf20Sopenharmony_ci case CPM_CLK_SCC3: 2188c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_scr; 2198c2ecf20Sopenharmony_ci shift = 8; 2208c2ecf20Sopenharmony_ci break; 2218c2ecf20Sopenharmony_ci case CPM_CLK_SCC4: 2228c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_scr; 2238c2ecf20Sopenharmony_ci shift = 0; 2248c2ecf20Sopenharmony_ci break; 2258c2ecf20Sopenharmony_ci case CPM_CLK_FCC1: 2268c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_fcr; 2278c2ecf20Sopenharmony_ci shift = 24; 2288c2ecf20Sopenharmony_ci break; 2298c2ecf20Sopenharmony_ci case CPM_CLK_FCC2: 2308c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_fcr; 2318c2ecf20Sopenharmony_ci shift = 16; 2328c2ecf20Sopenharmony_ci break; 2338c2ecf20Sopenharmony_ci case CPM_CLK_FCC3: 2348c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_fcr; 2358c2ecf20Sopenharmony_ci shift = 8; 2368c2ecf20Sopenharmony_ci break; 2378c2ecf20Sopenharmony_ci default: 2388c2ecf20Sopenharmony_ci printk(KERN_ERR "cpm2_clock_setup: invalid clock target\n"); 2398c2ecf20Sopenharmony_ci return -EINVAL; 2408c2ecf20Sopenharmony_ci } 2418c2ecf20Sopenharmony_ci 2428c2ecf20Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(clk_map); i++) { 2438c2ecf20Sopenharmony_ci if (clk_map[i][0] == target && clk_map[i][1] == clock) { 2448c2ecf20Sopenharmony_ci bits = clk_map[i][2]; 2458c2ecf20Sopenharmony_ci break; 2468c2ecf20Sopenharmony_ci } 2478c2ecf20Sopenharmony_ci } 2488c2ecf20Sopenharmony_ci if (i == ARRAY_SIZE(clk_map)) 2498c2ecf20Sopenharmony_ci ret = -EINVAL; 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_ci bits <<= shift; 2528c2ecf20Sopenharmony_ci mask <<= shift; 2538c2ecf20Sopenharmony_ci 2548c2ecf20Sopenharmony_ci if (mode == CPM_CLK_RTX) { 2558c2ecf20Sopenharmony_ci bits |= bits << 3; 2568c2ecf20Sopenharmony_ci mask |= mask << 3; 2578c2ecf20Sopenharmony_ci } else if (mode == CPM_CLK_RX) { 2588c2ecf20Sopenharmony_ci bits <<= 3; 2598c2ecf20Sopenharmony_ci mask <<= 3; 2608c2ecf20Sopenharmony_ci } 2618c2ecf20Sopenharmony_ci 2628c2ecf20Sopenharmony_ci out_be32(reg, (in_be32(reg) & ~mask) | bits); 2638c2ecf20Sopenharmony_ci 2648c2ecf20Sopenharmony_ci cpm2_unmap(im_cpmux); 2658c2ecf20Sopenharmony_ci return ret; 2668c2ecf20Sopenharmony_ci} 2678c2ecf20Sopenharmony_ci 2688c2ecf20Sopenharmony_ciint cpm2_smc_clk_setup(enum cpm_clk_target target, int clock) 2698c2ecf20Sopenharmony_ci{ 2708c2ecf20Sopenharmony_ci int ret = 0; 2718c2ecf20Sopenharmony_ci int shift; 2728c2ecf20Sopenharmony_ci int i, bits = 0; 2738c2ecf20Sopenharmony_ci cpmux_t __iomem *im_cpmux; 2748c2ecf20Sopenharmony_ci u8 __iomem *reg; 2758c2ecf20Sopenharmony_ci u8 mask = 3; 2768c2ecf20Sopenharmony_ci 2778c2ecf20Sopenharmony_ci u8 clk_map[][3] = { 2788c2ecf20Sopenharmony_ci {CPM_CLK_SMC1, CPM_BRG1, 0}, 2798c2ecf20Sopenharmony_ci {CPM_CLK_SMC1, CPM_BRG7, 1}, 2808c2ecf20Sopenharmony_ci {CPM_CLK_SMC1, CPM_CLK7, 2}, 2818c2ecf20Sopenharmony_ci {CPM_CLK_SMC1, CPM_CLK9, 3}, 2828c2ecf20Sopenharmony_ci {CPM_CLK_SMC2, CPM_BRG2, 0}, 2838c2ecf20Sopenharmony_ci {CPM_CLK_SMC2, CPM_BRG8, 1}, 2848c2ecf20Sopenharmony_ci {CPM_CLK_SMC2, CPM_CLK4, 2}, 2858c2ecf20Sopenharmony_ci {CPM_CLK_SMC2, CPM_CLK15, 3}, 2868c2ecf20Sopenharmony_ci }; 2878c2ecf20Sopenharmony_ci 2888c2ecf20Sopenharmony_ci im_cpmux = cpm2_map(im_cpmux); 2898c2ecf20Sopenharmony_ci 2908c2ecf20Sopenharmony_ci switch (target) { 2918c2ecf20Sopenharmony_ci case CPM_CLK_SMC1: 2928c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_smr; 2938c2ecf20Sopenharmony_ci mask = 3; 2948c2ecf20Sopenharmony_ci shift = 4; 2958c2ecf20Sopenharmony_ci break; 2968c2ecf20Sopenharmony_ci case CPM_CLK_SMC2: 2978c2ecf20Sopenharmony_ci reg = &im_cpmux->cmx_smr; 2988c2ecf20Sopenharmony_ci mask = 3; 2998c2ecf20Sopenharmony_ci shift = 0; 3008c2ecf20Sopenharmony_ci break; 3018c2ecf20Sopenharmony_ci default: 3028c2ecf20Sopenharmony_ci printk(KERN_ERR "cpm2_smc_clock_setup: invalid clock target\n"); 3038c2ecf20Sopenharmony_ci return -EINVAL; 3048c2ecf20Sopenharmony_ci } 3058c2ecf20Sopenharmony_ci 3068c2ecf20Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(clk_map); i++) { 3078c2ecf20Sopenharmony_ci if (clk_map[i][0] == target && clk_map[i][1] == clock) { 3088c2ecf20Sopenharmony_ci bits = clk_map[i][2]; 3098c2ecf20Sopenharmony_ci break; 3108c2ecf20Sopenharmony_ci } 3118c2ecf20Sopenharmony_ci } 3128c2ecf20Sopenharmony_ci if (i == ARRAY_SIZE(clk_map)) 3138c2ecf20Sopenharmony_ci ret = -EINVAL; 3148c2ecf20Sopenharmony_ci 3158c2ecf20Sopenharmony_ci bits <<= shift; 3168c2ecf20Sopenharmony_ci mask <<= shift; 3178c2ecf20Sopenharmony_ci 3188c2ecf20Sopenharmony_ci out_8(reg, (in_8(reg) & ~mask) | bits); 3198c2ecf20Sopenharmony_ci 3208c2ecf20Sopenharmony_ci cpm2_unmap(im_cpmux); 3218c2ecf20Sopenharmony_ci return ret; 3228c2ecf20Sopenharmony_ci} 3238c2ecf20Sopenharmony_ci 3248c2ecf20Sopenharmony_cistruct cpm2_ioports { 3258c2ecf20Sopenharmony_ci u32 dir, par, sor, odr, dat; 3268c2ecf20Sopenharmony_ci u32 res[3]; 3278c2ecf20Sopenharmony_ci}; 3288c2ecf20Sopenharmony_ci 3298c2ecf20Sopenharmony_civoid cpm2_set_pin(int port, int pin, int flags) 3308c2ecf20Sopenharmony_ci{ 3318c2ecf20Sopenharmony_ci struct cpm2_ioports __iomem *iop = 3328c2ecf20Sopenharmony_ci (struct cpm2_ioports __iomem *)&cpm2_immr->im_ioport; 3338c2ecf20Sopenharmony_ci 3348c2ecf20Sopenharmony_ci pin = 1 << (31 - pin); 3358c2ecf20Sopenharmony_ci 3368c2ecf20Sopenharmony_ci if (flags & CPM_PIN_OUTPUT) 3378c2ecf20Sopenharmony_ci setbits32(&iop[port].dir, pin); 3388c2ecf20Sopenharmony_ci else 3398c2ecf20Sopenharmony_ci clrbits32(&iop[port].dir, pin); 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_ci if (!(flags & CPM_PIN_GPIO)) 3428c2ecf20Sopenharmony_ci setbits32(&iop[port].par, pin); 3438c2ecf20Sopenharmony_ci else 3448c2ecf20Sopenharmony_ci clrbits32(&iop[port].par, pin); 3458c2ecf20Sopenharmony_ci 3468c2ecf20Sopenharmony_ci if (flags & CPM_PIN_SECONDARY) 3478c2ecf20Sopenharmony_ci setbits32(&iop[port].sor, pin); 3488c2ecf20Sopenharmony_ci else 3498c2ecf20Sopenharmony_ci clrbits32(&iop[port].sor, pin); 3508c2ecf20Sopenharmony_ci 3518c2ecf20Sopenharmony_ci if (flags & CPM_PIN_OPENDRAIN) 3528c2ecf20Sopenharmony_ci setbits32(&iop[port].odr, pin); 3538c2ecf20Sopenharmony_ci else 3548c2ecf20Sopenharmony_ci clrbits32(&iop[port].odr, pin); 3558c2ecf20Sopenharmony_ci} 356