2009-06-23 13:46:15 +00:00
|
|
|
/*
|
2012-01-02 11:44:00 +00:00
|
|
|
* (c) 2009...2011 Juergen Beisert <j.beisert@pengutronix.de>
|
2009-06-23 13:46:15 +00:00
|
|
|
*
|
|
|
|
* Based on code from:
|
|
|
|
* (c) 2004 Sascha Hauer <sascha@saschahauer.de>
|
|
|
|
*
|
|
|
|
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <common.h>
|
|
|
|
#include <driver.h>
|
|
|
|
#include <init.h>
|
|
|
|
#include <malloc.h>
|
2011-09-22 17:02:57 +00:00
|
|
|
#include <io.h>
|
2012-01-02 11:43:51 +00:00
|
|
|
#include <mach/s3c-generic.h>
|
|
|
|
#include <mach/s3c-iomap.h>
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* Note: Offsets are for little endian access */
|
|
|
|
#define ULCON 0x00 /* line control */
|
|
|
|
#define UCON 0x04 /* UART control */
|
|
|
|
#define UFCON 0x08 /* FIFO control */
|
|
|
|
#define UMCON 0x0c /* modem control */
|
|
|
|
#define UTRSTAT 0x10 /* Rx/Tx status */
|
|
|
|
#define UERSTAT 0x14 /* error status */
|
|
|
|
#define UFSTAT 0x18 /* FIFO status */
|
|
|
|
#define UMSTAT 0x1c /* modem status */
|
|
|
|
#define UTXH 0x20 /* transmitt */
|
|
|
|
#define URXH 0x24 /* receive */
|
|
|
|
#define UBRDIV 0x28 /* baudrate generator */
|
2012-05-14 09:38:05 +00:00
|
|
|
#ifdef S3C_UART_HAS_UBRDIVSLOT
|
|
|
|
# define UBRDIVSLOT 0x2c /* baudrate slot generator */
|
|
|
|
#endif
|
|
|
|
#ifdef S3C_UART_HAS_UINTM
|
|
|
|
# define UINTM 0x38 /* interrupt mask register */
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifndef S3C_UART_CLKSEL
|
|
|
|
/* Use pclk */
|
|
|
|
# define S3C_UART_CLKSEL 0
|
|
|
|
#endif
|
2009-06-23 13:46:15 +00:00
|
|
|
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart {
|
|
|
|
void __iomem *regs;
|
|
|
|
struct console_device cdev;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define to_s3c_uart(c) container_of(c, struct s3c_uart, cdev)
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static unsigned s3c_get_arch_uart_input_clock(void __iomem *base)
|
|
|
|
{
|
|
|
|
unsigned reg = readw(base + UCON);
|
2012-05-14 09:38:05 +00:00
|
|
|
reg = (reg >> 10) & 0x3;
|
|
|
|
return s3c_get_uart_clk(reg);
|
2012-01-02 11:44:00 +00:00
|
|
|
}
|
|
|
|
|
2012-05-14 09:38:05 +00:00
|
|
|
#ifdef S3C_UART_HAS_UBRDIVSLOT
|
|
|
|
/*
|
|
|
|
* This table takes the fractional value of the baud divisor and gives
|
|
|
|
* the recommended setting for the UDIVSLOT register. Refer the datasheet
|
|
|
|
* for further details
|
|
|
|
*/
|
|
|
|
static const uint16_t udivslot_table[] __maybe_unused = {
|
|
|
|
0x0000, 0x0080, 0x0808, 0x0888, 0x2222, 0x4924, 0x4A52, 0x54AA,
|
|
|
|
0x5555, 0xD555, 0xD5D5, 0xDDD5, 0xDDDD, 0xDFDD, 0xDFDF, 0xFFDF,
|
|
|
|
};
|
|
|
|
#endif
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_setbaudrate(struct console_device *cdev, int baudrate)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
unsigned val;
|
|
|
|
|
2012-05-14 09:38:05 +00:00
|
|
|
#ifdef S3C_UART_HAS_UBRDIVSLOT
|
|
|
|
val = s3c_get_arch_uart_input_clock(base) / baudrate;
|
|
|
|
writew(udivslot_table[val & 15], base + UBRDIVSLOT);
|
|
|
|
#endif
|
2012-01-02 11:44:00 +00:00
|
|
|
val = s3c_get_arch_uart_input_clock(base) / (16 * baudrate) - 1;
|
2011-07-28 13:05:34 +00:00
|
|
|
writew(val, base + UBRDIV);
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_init_port(struct console_device *cdev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* FIFO enable, Tx/Rx FIFO clear */
|
2011-07-28 13:05:34 +00:00
|
|
|
writeb(0x07, base + UFCON);
|
|
|
|
writeb(0x00, base + UMCON);
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* Normal,No parity,1 stop,8 bit */
|
2011-07-28 13:05:34 +00:00
|
|
|
writeb(0x03, base + ULCON);
|
2012-05-14 09:38:05 +00:00
|
|
|
|
|
|
|
/* tx=level,rx=edge,disable timeout int.,enable rx error int.,
|
|
|
|
* normal, interrupt or polling, no pre-divider */
|
|
|
|
writew(0x0245 | ((S3C_UART_CLKSEL) << 10), base + UCON);
|
|
|
|
|
|
|
|
#ifdef S3C_UART_HAS_UINTM
|
|
|
|
/* 'interrupt or polling mode' for both directions */
|
|
|
|
writeb(0xf, base + UINTM);
|
|
|
|
#endif
|
2009-06-23 13:46:15 +00:00
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
#ifdef CONFIG_DRIVER_SERIAL_S3C_AUTOSYNC
|
2011-11-26 18:32:49 +00:00
|
|
|
writeb(0x10, base + UMCON); /* enable auto flow control */
|
|
|
|
#else
|
2011-07-28 13:05:34 +00:00
|
|
|
writeb(0x01, base + UMCON); /* RTS up */
|
2009-06-23 13:46:15 +00:00
|
|
|
#endif
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static void s3c_serial_putc(struct console_device *cdev, char c)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* Wait for Tx FIFO not full */
|
2011-07-28 13:05:34 +00:00
|
|
|
while (!(readb(base + UTRSTAT) & 0x2))
|
2009-06-23 13:46:15 +00:00
|
|
|
;
|
|
|
|
|
2011-07-28 13:05:34 +00:00
|
|
|
writeb(c, base + UTXH);
|
2009-06-23 13:46:15 +00:00
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_tstc(struct console_device *cdev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* If receive fifo is empty, return false */
|
2011-07-28 13:05:34 +00:00
|
|
|
if (readb(base + UTRSTAT) & 0x1)
|
2009-06-23 13:46:15 +00:00
|
|
|
return 1;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_getc(struct console_device *cdev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* wait for a character */
|
2011-07-28 13:05:34 +00:00
|
|
|
while (!(readb(base + UTRSTAT) & 0x1))
|
2009-06-23 13:46:15 +00:00
|
|
|
;
|
|
|
|
|
2011-07-28 13:05:34 +00:00
|
|
|
return readb(base + URXH);
|
2009-06-23 13:46:15 +00:00
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static void s3c_serial_flush(struct console_device *cdev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv = to_s3c_uart(cdev);
|
|
|
|
void __iomem *base = priv->regs;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
2011-07-28 13:05:34 +00:00
|
|
|
while (!(readb(base + UTRSTAT) & 0x4))
|
2009-06-23 13:46:15 +00:00
|
|
|
;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_probe(struct device_d *dev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv;
|
2009-06-23 13:46:15 +00:00
|
|
|
struct console_device *cdev;
|
|
|
|
|
2012-03-12 13:57:59 +00:00
|
|
|
priv = xzalloc(sizeof(struct s3c_uart));
|
2012-02-25 13:31:33 +00:00
|
|
|
cdev = &priv->cdev;
|
|
|
|
priv->regs = dev_request_mem_region(dev, 0);
|
|
|
|
dev->priv = priv;
|
2009-06-23 13:46:15 +00:00
|
|
|
cdev->dev = dev;
|
|
|
|
cdev->f_caps = CONSOLE_STDIN | CONSOLE_STDOUT | CONSOLE_STDERR;
|
2012-01-02 11:44:00 +00:00
|
|
|
cdev->tstc = s3c_serial_tstc;
|
|
|
|
cdev->putc = s3c_serial_putc;
|
|
|
|
cdev->getc = s3c_serial_getc;
|
|
|
|
cdev->flush = s3c_serial_flush;
|
|
|
|
cdev->setbrg = s3c_serial_setbaudrate;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
s3c_serial_init_port(cdev);
|
2009-06-23 13:46:15 +00:00
|
|
|
|
|
|
|
/* Enable UART */
|
|
|
|
console_register(cdev);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static void s3c_serial_remove(struct device_d *dev)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-02-25 13:31:33 +00:00
|
|
|
struct s3c_uart *priv= dev->priv;
|
2009-06-23 13:46:15 +00:00
|
|
|
|
2012-02-25 13:31:33 +00:00
|
|
|
s3c_serial_flush(&priv->cdev);
|
|
|
|
console_unregister(&priv->cdev);
|
|
|
|
free(priv);
|
2009-06-23 13:46:15 +00:00
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static struct driver_d s3c_serial_driver = {
|
|
|
|
.name = "s3c_serial",
|
|
|
|
.probe = s3c_serial_probe,
|
|
|
|
.remove = s3c_serial_remove,
|
2009-06-23 13:46:15 +00:00
|
|
|
};
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
static int s3c_serial_init(void)
|
2009-06-23 13:46:15 +00:00
|
|
|
{
|
2012-01-02 11:44:00 +00:00
|
|
|
register_driver(&s3c_serial_driver);
|
2009-06-23 13:46:15 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-01-02 11:44:00 +00:00
|
|
|
console_initcall(s3c_serial_init);
|