2 * CPM serial console support.
4 * Copyright 2007 Freescale Semiconductor, Inc.
5 * Author: Scott Wood <scottwood@freescale.com>
7 * It is assumed that the firmware (or the platform file) has already set
48 u16 sc; /* Status and Control */
49 u16 len; /* Data length in buffer */
50 u8 *addr; /* Buffer address in host memory */
54 static struct cpm_param *param;
55 static struct cpm_smc *smc;
56 static struct cpm_scc *scc;
57 struct cpm_bd *tbdf, *rbdf;
59 static u8 *dpram_start;
61 static void (*do_cmd)(int op);
62 static void (*enable_port)(void);
63 static void (*disable_port)(void);
65 #define CPM_CMD_STOP_TX 4
66 #define CPM_CMD_RESTART_TX 6
67 #define CPM_CMD_INIT_RX_TX 0
69 static void cpm1_cmd(int op)
71 while (in_be16(cpcr) & 1)
74 out_be16(cpcr, (op << 8) | cpm_cmd | 1);
76 while (in_be16(cpcr) & 1)
80 static void cpm2_cmd(int op)
82 while (in_be32(cpcr) & 0x10000)
85 out_be32(cpcr, op | cpm_cmd | 0x10000);
87 while (in_be32(cpcr) & 0x10000)
91 static void smc_disable_port(void)
93 do_cmd(CPM_CMD_STOP_TX);
94 out_be16(&smc->smcmr, in_be16(&smc->smcmr) & ~3);
97 static void scc_disable_port(void)
99 do_cmd(CPM_CMD_STOP_TX);
100 out_be32(&scc->gsmrl, in_be32(&scc->gsmrl) & ~0x30);
103 static void smc_enable_port(void)
105 out_be16(&smc->smcmr, in_be16(&smc->smcmr) | 3);
106 do_cmd(CPM_CMD_RESTART_TX);
109 static void scc_enable_port(void)
111 out_be32(&scc->gsmrl, in_be32(&scc->gsmrl) | 0x30);
112 do_cmd(CPM_CMD_RESTART_TX);
115 static int cpm_serial_open(void)
120 out_8(¶m->rfcr, 0x10);
121 out_8(¶m->tfcr, 0x10);
123 rbdf = (struct cpm_bd *)(dpram_start + dpaddr);
124 rbdf->addr = (u8 *)(rbdf + 2);
129 tbdf->addr = (u8 *)(rbdf + 2) + 1;
134 out_be16(¶m->rbase, dpaddr);
135 out_be16(¶m->tbase, dpaddr + sizeof(struct cpm_bd));
137 do_cmd(CPM_CMD_INIT_RX_TX);
143 static void cpm_serial_putc(unsigned char c)
145 while (tbdf->sc & 0x8000)
155 static unsigned char cpm_serial_tstc(void)
158 return !(rbdf->sc & 0x8000);
161 static unsigned char cpm_serial_getc(void)
165 while (!cpm_serial_tstc())
176 int cpm_console_init(void *devp, struct serial_console_data *scdp)
179 int is_smc = 0, is_cpm2 = 0, n;
180 unsigned long reg_phys;
183 if (dt_is_compatible(devp, "fsl,cpm1-smc-uart")) {
185 } else if (dt_is_compatible(devp, "fsl,cpm2-scc-uart")) {
187 } else if (dt_is_compatible(devp, "fsl,cpm2-smc-uart")) {
193 enable_port = smc_enable_port;
194 disable_port = smc_disable_port;
196 enable_port = scc_enable_port;
197 disable_port = scc_disable_port;
205 n = getprop(devp, "fsl,cpm-command", &cpm_cmd, 4);
209 n = getprop(devp, "virtual-reg", reg_virt, sizeof(reg_virt));
210 if (n < (int)sizeof(reg_virt)) {
211 for (n = 0; n < 2; n++) {
212 if (!dt_xlate_reg(devp, n, ®_phys, NULL))
215 reg_virt[n] = (void *)reg_phys;
226 parent = get_parent(devp);
230 n = getprop(parent, "virtual-reg", reg_virt, sizeof(reg_virt));
231 if (n < (int)sizeof(reg_virt)) {
232 for (n = 0; n < 2; n++) {
233 if (!dt_xlate_reg(parent, n, ®_phys, NULL))
236 reg_virt[n] = (void *)reg_phys;
241 dpram_start = reg_virt[1];
243 scdp->open = cpm_serial_open;
244 scdp->putc = cpm_serial_putc;
245 scdp->getc = cpm_serial_getc;
246 scdp->tstc = cpm_serial_tstc;