hc
2024-01-05 071106ecf68c401173c58808b1cf5f68cc50d390
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
// SPDX-License-Identifier: GPL-2.0+
/*
 *  Driver for CPM (SCC/SMC) serial ports; CPM1 definitions
 *
 *  Maintainer: Kumar Gala (galak@kernel.crashing.org) (CPM2)
 *              Pantelis Antoniou (panto@intracom.gr) (CPM1)
 *
 *  Copyright (C) 2004 Freescale Semiconductor, Inc.
 *            (C) 2004 Intracom, S.A.
 *            (C) 2006 MontaVista Software, Inc.
 *        Vitaly Bordug <vbordug@ru.mvista.com>
 */
 
#include <linux/module.h>
#include <linux/tty.h>
#include <linux/gfp.h>
#include <linux/ioport.h>
#include <linux/serial.h>
#include <linux/console.h>
#include <linux/sysrq.h>
#include <linux/device.h>
#include <linux/memblock.h>
#include <linux/dma-mapping.h>
 
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/fs_pd.h>
 
#include <linux/serial_core.h>
#include <linux/kernel.h>
 
#include <linux/of.h>
#include <linux/of_address.h>
 
#include "cpm_uart.h"
 
/**************************************************************/
 
void cpm_line_cr_cmd(struct uart_cpm_port *port, int cmd)
{
   cpm_command(port->command, cmd);
}
 
void __iomem *cpm_uart_map_pram(struct uart_cpm_port *port,
               struct device_node *np)
{
   return of_iomap(np, 1);
}
 
void cpm_uart_unmap_pram(struct uart_cpm_port *port, void __iomem *pram)
{
   iounmap(pram);
}
 
/*
 * Allocate DP-Ram and memory buffers. We need to allocate a transmit and
 * receive buffer descriptors from dual port ram, and a character
 * buffer area from host mem. If we are allocating for the console we need
 * to do it from bootmem
 */
int cpm_uart_allocbuf(struct uart_cpm_port *pinfo, unsigned int is_con)
{
   int dpmemsz, memsz;
   u8 *dp_mem;
   unsigned long dp_offset;
   u8 *mem_addr;
   dma_addr_t dma_addr = 0;
 
   pr_debug("CPM uart[%d]:allocbuf\n", pinfo->port.line);
 
   dpmemsz = sizeof(cbd_t) * (pinfo->rx_nrfifos + pinfo->tx_nrfifos);
   dp_offset = cpm_dpalloc(dpmemsz, 8);
   if (IS_ERR_VALUE(dp_offset)) {
       printk(KERN_ERR
              "cpm_uart_cpm1.c: could not allocate buffer descriptors\n");
       return -ENOMEM;
   }
   dp_mem = cpm_dpram_addr(dp_offset);
 
   memsz = L1_CACHE_ALIGN(pinfo->rx_nrfifos * pinfo->rx_fifosize) +
       L1_CACHE_ALIGN(pinfo->tx_nrfifos * pinfo->tx_fifosize);
   if (is_con) {
       /* was hostalloc but changed cause it blows away the */
       /* large tlb mapping when pinning the kernel area    */
       mem_addr = (u8 *) cpm_dpram_addr(cpm_dpalloc(memsz, 8));
       dma_addr = (u32)cpm_dpram_phys(mem_addr);
   } else
       mem_addr = dma_alloc_coherent(pinfo->port.dev, memsz, &dma_addr,
                         GFP_KERNEL);
 
   if (mem_addr == NULL) {
       cpm_dpfree(dp_offset);
       printk(KERN_ERR
              "cpm_uart_cpm1.c: could not allocate coherent memory\n");
       return -ENOMEM;
   }
 
   pinfo->dp_addr = dp_offset;
   pinfo->mem_addr = mem_addr;             /*  virtual address*/
   pinfo->dma_addr = dma_addr;             /*  physical address*/
   pinfo->mem_size = memsz;
 
   pinfo->rx_buf = mem_addr;
   pinfo->tx_buf = pinfo->rx_buf + L1_CACHE_ALIGN(pinfo->rx_nrfifos
                              * pinfo->rx_fifosize);
 
   pinfo->rx_bd_base = (cbd_t __iomem __force *)dp_mem;
   pinfo->tx_bd_base = pinfo->rx_bd_base + pinfo->rx_nrfifos;
 
   return 0;
}
 
void cpm_uart_freebuf(struct uart_cpm_port *pinfo)
{
   dma_free_coherent(pinfo->port.dev, L1_CACHE_ALIGN(pinfo->rx_nrfifos *
                             pinfo->rx_fifosize) +
             L1_CACHE_ALIGN(pinfo->tx_nrfifos *
                    pinfo->tx_fifosize), pinfo->mem_addr,
             pinfo->dma_addr);
 
   cpm_dpfree(pinfo->dp_addr);
}