Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 *  Maxim (Dallas) MAX3107/8/9, MAX14830 serial driver
   4 *
   5 *  Copyright (C) 2012-2016 Alexander Shiyan <shc_work@mail.ru>
   6 *
   7 *  Based on max3100.c, by Christian Pellegrin <chripell@evolware.org>
   8 *  Based on max3110.c, by Feng Tang <feng.tang@intel.com>
   9 *  Based on max3107.c, by Aavamobile
  10 */
  11
  12#include <linux/bitops.h>
  13#include <linux/clk.h>
  14#include <linux/delay.h>
  15#include <linux/device.h>
  16#include <linux/gpio/driver.h>
  17#include <linux/module.h>
  18#include <linux/of.h>
  19#include <linux/of_device.h>
  20#include <linux/regmap.h>
  21#include <linux/serial_core.h>
  22#include <linux/serial.h>
  23#include <linux/tty.h>
  24#include <linux/tty_flip.h>
  25#include <linux/spi/spi.h>
  26#include <linux/uaccess.h>
  27
  28#define MAX310X_NAME			"max310x"
  29#define MAX310X_MAJOR			204
  30#define MAX310X_MINOR			209
  31#define MAX310X_UART_NRMAX		16
  32
  33/* MAX310X register definitions */
  34#define MAX310X_RHR_REG			(0x00) /* RX FIFO */
  35#define MAX310X_THR_REG			(0x00) /* TX FIFO */
  36#define MAX310X_IRQEN_REG		(0x01) /* IRQ enable */
  37#define MAX310X_IRQSTS_REG		(0x02) /* IRQ status */
  38#define MAX310X_LSR_IRQEN_REG		(0x03) /* LSR IRQ enable */
  39#define MAX310X_LSR_IRQSTS_REG		(0x04) /* LSR IRQ status */
  40#define MAX310X_REG_05			(0x05)
  41#define MAX310X_SPCHR_IRQEN_REG		MAX310X_REG_05 /* Special char IRQ en */
  42#define MAX310X_SPCHR_IRQSTS_REG	(0x06) /* Special char IRQ status */
  43#define MAX310X_STS_IRQEN_REG		(0x07) /* Status IRQ enable */
  44#define MAX310X_STS_IRQSTS_REG		(0x08) /* Status IRQ status */
  45#define MAX310X_MODE1_REG		(0x09) /* MODE1 */
  46#define MAX310X_MODE2_REG		(0x0a) /* MODE2 */
  47#define MAX310X_LCR_REG			(0x0b) /* LCR */
  48#define MAX310X_RXTO_REG		(0x0c) /* RX timeout */
  49#define MAX310X_HDPIXDELAY_REG		(0x0d) /* Auto transceiver delays */
  50#define MAX310X_IRDA_REG		(0x0e) /* IRDA settings */
  51#define MAX310X_FLOWLVL_REG		(0x0f) /* Flow control levels */
  52#define MAX310X_FIFOTRIGLVL_REG		(0x10) /* FIFO IRQ trigger levels */
  53#define MAX310X_TXFIFOLVL_REG		(0x11) /* TX FIFO level */
  54#define MAX310X_RXFIFOLVL_REG		(0x12) /* RX FIFO level */
  55#define MAX310X_FLOWCTRL_REG		(0x13) /* Flow control */
  56#define MAX310X_XON1_REG		(0x14) /* XON1 character */
  57#define MAX310X_XON2_REG		(0x15) /* XON2 character */
  58#define MAX310X_XOFF1_REG		(0x16) /* XOFF1 character */
  59#define MAX310X_XOFF2_REG		(0x17) /* XOFF2 character */
  60#define MAX310X_GPIOCFG_REG		(0x18) /* GPIO config */
  61#define MAX310X_GPIODATA_REG		(0x19) /* GPIO data */
  62#define MAX310X_PLLCFG_REG		(0x1a) /* PLL config */
  63#define MAX310X_BRGCFG_REG		(0x1b) /* Baud rate generator conf */
  64#define MAX310X_BRGDIVLSB_REG		(0x1c) /* Baud rate divisor LSB */
  65#define MAX310X_BRGDIVMSB_REG		(0x1d) /* Baud rate divisor MSB */
  66#define MAX310X_CLKSRC_REG		(0x1e) /* Clock source */
  67#define MAX310X_REG_1F			(0x1f)
  68
  69#define MAX310X_REVID_REG		MAX310X_REG_1F /* Revision ID */
  70
  71#define MAX310X_GLOBALIRQ_REG		MAX310X_REG_1F /* Global IRQ (RO) */
  72#define MAX310X_GLOBALCMD_REG		MAX310X_REG_1F /* Global Command (WO) */
  73
  74/* Extended registers */
  75#define MAX310X_REVID_EXTREG		MAX310X_REG_05 /* Revision ID */
  76
  77/* IRQ register bits */
  78#define MAX310X_IRQ_LSR_BIT		(1 << 0) /* LSR interrupt */
  79#define MAX310X_IRQ_SPCHR_BIT		(1 << 1) /* Special char interrupt */
  80#define MAX310X_IRQ_STS_BIT		(1 << 2) /* Status interrupt */
  81#define MAX310X_IRQ_RXFIFO_BIT		(1 << 3) /* RX FIFO interrupt */
  82#define MAX310X_IRQ_TXFIFO_BIT		(1 << 4) /* TX FIFO interrupt */
  83#define MAX310X_IRQ_TXEMPTY_BIT		(1 << 5) /* TX FIFO empty interrupt */
  84#define MAX310X_IRQ_RXEMPTY_BIT		(1 << 6) /* RX FIFO empty interrupt */
  85#define MAX310X_IRQ_CTS_BIT		(1 << 7) /* CTS interrupt */
  86
  87/* LSR register bits */
  88#define MAX310X_LSR_RXTO_BIT		(1 << 0) /* RX timeout */
  89#define MAX310X_LSR_RXOVR_BIT		(1 << 1) /* RX overrun */
  90#define MAX310X_LSR_RXPAR_BIT		(1 << 2) /* RX parity error */
  91#define MAX310X_LSR_FRERR_BIT		(1 << 3) /* Frame error */
  92#define MAX310X_LSR_RXBRK_BIT		(1 << 4) /* RX break */
  93#define MAX310X_LSR_RXNOISE_BIT		(1 << 5) /* RX noise */
  94#define MAX310X_LSR_CTS_BIT		(1 << 7) /* CTS pin state */
  95
  96/* Special character register bits */
  97#define MAX310X_SPCHR_XON1_BIT		(1 << 0) /* XON1 character */
  98#define MAX310X_SPCHR_XON2_BIT		(1 << 1) /* XON2 character */
  99#define MAX310X_SPCHR_XOFF1_BIT		(1 << 2) /* XOFF1 character */
 100#define MAX310X_SPCHR_XOFF2_BIT		(1 << 3) /* XOFF2 character */
 101#define MAX310X_SPCHR_BREAK_BIT		(1 << 4) /* RX break */
 102#define MAX310X_SPCHR_MULTIDROP_BIT	(1 << 5) /* 9-bit multidrop addr char */
 103
 104/* Status register bits */
 105#define MAX310X_STS_GPIO0_BIT		(1 << 0) /* GPIO 0 interrupt */
 106#define MAX310X_STS_GPIO1_BIT		(1 << 1) /* GPIO 1 interrupt */
 107#define MAX310X_STS_GPIO2_BIT		(1 << 2) /* GPIO 2 interrupt */
 108#define MAX310X_STS_GPIO3_BIT		(1 << 3) /* GPIO 3 interrupt */
 109#define MAX310X_STS_CLKREADY_BIT	(1 << 5) /* Clock ready */
 110#define MAX310X_STS_SLEEP_BIT		(1 << 6) /* Sleep interrupt */
 111
 112/* MODE1 register bits */
 113#define MAX310X_MODE1_RXDIS_BIT		(1 << 0) /* RX disable */
 114#define MAX310X_MODE1_TXDIS_BIT		(1 << 1) /* TX disable */
 115#define MAX310X_MODE1_TXHIZ_BIT		(1 << 2) /* TX pin three-state */
 116#define MAX310X_MODE1_RTSHIZ_BIT	(1 << 3) /* RTS pin three-state */
 117#define MAX310X_MODE1_TRNSCVCTRL_BIT	(1 << 4) /* Transceiver ctrl enable */
 118#define MAX310X_MODE1_FORCESLEEP_BIT	(1 << 5) /* Force sleep mode */
 119#define MAX310X_MODE1_AUTOSLEEP_BIT	(1 << 6) /* Auto sleep enable */
 120#define MAX310X_MODE1_IRQSEL_BIT	(1 << 7) /* IRQ pin enable */
 121
 122/* MODE2 register bits */
 123#define MAX310X_MODE2_RST_BIT		(1 << 0) /* Chip reset */
 124#define MAX310X_MODE2_FIFORST_BIT	(1 << 1) /* FIFO reset */
 125#define MAX310X_MODE2_RXTRIGINV_BIT	(1 << 2) /* RX FIFO INT invert */
 126#define MAX310X_MODE2_RXEMPTINV_BIT	(1 << 3) /* RX FIFO empty INT invert */
 127#define MAX310X_MODE2_SPCHR_BIT		(1 << 4) /* Special chr detect enable */
 128#define MAX310X_MODE2_LOOPBACK_BIT	(1 << 5) /* Internal loopback enable */
 129#define MAX310X_MODE2_MULTIDROP_BIT	(1 << 6) /* 9-bit multidrop enable */
 130#define MAX310X_MODE2_ECHOSUPR_BIT	(1 << 7) /* ECHO suppression enable */
 131
 132/* LCR register bits */
 133#define MAX310X_LCR_LENGTH0_BIT		(1 << 0) /* Word length bit 0 */
 134#define MAX310X_LCR_LENGTH1_BIT		(1 << 1) /* Word length bit 1
 135						  *
 136						  * Word length bits table:
 137						  * 00 -> 5 bit words
 138						  * 01 -> 6 bit words
 139						  * 10 -> 7 bit words
 140						  * 11 -> 8 bit words
 141						  */
 142#define MAX310X_LCR_STOPLEN_BIT		(1 << 2) /* STOP length bit
 143						  *
 144						  * STOP length bit table:
 145						  * 0 -> 1 stop bit
 146						  * 1 -> 1-1.5 stop bits if
 147						  *      word length is 5,
 148						  *      2 stop bits otherwise
 149						  */
 150#define MAX310X_LCR_PARITY_BIT		(1 << 3) /* Parity bit enable */
 151#define MAX310X_LCR_EVENPARITY_BIT	(1 << 4) /* Even parity bit enable */
 152#define MAX310X_LCR_FORCEPARITY_BIT	(1 << 5) /* 9-bit multidrop parity */
 153#define MAX310X_LCR_TXBREAK_BIT		(1 << 6) /* TX break enable */
 154#define MAX310X_LCR_RTS_BIT		(1 << 7) /* RTS pin control */
 155
 156/* IRDA register bits */
 157#define MAX310X_IRDA_IRDAEN_BIT		(1 << 0) /* IRDA mode enable */
 158#define MAX310X_IRDA_SIR_BIT		(1 << 1) /* SIR mode enable */
 159
 160/* Flow control trigger level register masks */
 161#define MAX310X_FLOWLVL_HALT_MASK	(0x000f) /* Flow control halt level */
 162#define MAX310X_FLOWLVL_RES_MASK	(0x00f0) /* Flow control resume level */
 163#define MAX310X_FLOWLVL_HALT(words)	((words / 8) & 0x0f)
 164#define MAX310X_FLOWLVL_RES(words)	(((words / 8) & 0x0f) << 4)
 165
 166/* FIFO interrupt trigger level register masks */
 167#define MAX310X_FIFOTRIGLVL_TX_MASK	(0x0f) /* TX FIFO trigger level */
 168#define MAX310X_FIFOTRIGLVL_RX_MASK	(0xf0) /* RX FIFO trigger level */
 169#define MAX310X_FIFOTRIGLVL_TX(words)	((words / 8) & 0x0f)
 170#define MAX310X_FIFOTRIGLVL_RX(words)	(((words / 8) & 0x0f) << 4)
 171
 172/* Flow control register bits */
 173#define MAX310X_FLOWCTRL_AUTORTS_BIT	(1 << 0) /* Auto RTS flow ctrl enable */
 174#define MAX310X_FLOWCTRL_AUTOCTS_BIT	(1 << 1) /* Auto CTS flow ctrl enable */
 175#define MAX310X_FLOWCTRL_GPIADDR_BIT	(1 << 2) /* Enables that GPIO inputs
 176						  * are used in conjunction with
 177						  * XOFF2 for definition of
 178						  * special character */
 179#define MAX310X_FLOWCTRL_SWFLOWEN_BIT	(1 << 3) /* Auto SW flow ctrl enable */
 180#define MAX310X_FLOWCTRL_SWFLOW0_BIT	(1 << 4) /* SWFLOW bit 0 */
 181#define MAX310X_FLOWCTRL_SWFLOW1_BIT	(1 << 5) /* SWFLOW bit 1
 182						  *
 183						  * SWFLOW bits 1 & 0 table:
 184						  * 00 -> no transmitter flow
 185						  *       control
 186						  * 01 -> receiver compares
 187						  *       XON2 and XOFF2
 188						  *       and controls
 189						  *       transmitter
 190						  * 10 -> receiver compares
 191						  *       XON1 and XOFF1
 192						  *       and controls
 193						  *       transmitter
 194						  * 11 -> receiver compares
 195						  *       XON1, XON2, XOFF1 and
 196						  *       XOFF2 and controls
 197						  *       transmitter
 198						  */
 199#define MAX310X_FLOWCTRL_SWFLOW2_BIT	(1 << 6) /* SWFLOW bit 2 */
 200#define MAX310X_FLOWCTRL_SWFLOW3_BIT	(1 << 7) /* SWFLOW bit 3
 201						  *
 202						  * SWFLOW bits 3 & 2 table:
 203						  * 00 -> no received flow
 204						  *       control
 205						  * 01 -> transmitter generates
 206						  *       XON2 and XOFF2
 207						  * 10 -> transmitter generates
 208						  *       XON1 and XOFF1
 209						  * 11 -> transmitter generates
 210						  *       XON1, XON2, XOFF1 and
 211						  *       XOFF2
 212						  */
 213
 214/* PLL configuration register masks */
 215#define MAX310X_PLLCFG_PREDIV_MASK	(0x3f) /* PLL predivision value */
 216#define MAX310X_PLLCFG_PLLFACTOR_MASK	(0xc0) /* PLL multiplication factor */
 217
 218/* Baud rate generator configuration register bits */
 219#define MAX310X_BRGCFG_2XMODE_BIT	(1 << 4) /* Double baud rate */
 220#define MAX310X_BRGCFG_4XMODE_BIT	(1 << 5) /* Quadruple baud rate */
 221
 222/* Clock source register bits */
 223#define MAX310X_CLKSRC_CRYST_BIT	(1 << 1) /* Crystal osc enable */
 224#define MAX310X_CLKSRC_PLL_BIT		(1 << 2) /* PLL enable */
 225#define MAX310X_CLKSRC_PLLBYP_BIT	(1 << 3) /* PLL bypass */
 226#define MAX310X_CLKSRC_EXTCLK_BIT	(1 << 4) /* External clock enable */
 227#define MAX310X_CLKSRC_CLK2RTS_BIT	(1 << 7) /* Baud clk to RTS pin */
 228
 229/* Global commands */
 230#define MAX310X_EXTREG_ENBL		(0xce)
 231#define MAX310X_EXTREG_DSBL		(0xcd)
 232
 233/* Misc definitions */
 234#define MAX310X_FIFO_SIZE		(128)
 235#define MAX310x_REV_MASK		(0xf8)
 236#define MAX310X_WRITE_BIT		0x80
 237
 238/* MAX3107 specific */
 239#define MAX3107_REV_ID			(0xa0)
 240
 241/* MAX3109 specific */
 242#define MAX3109_REV_ID			(0xc0)
 243
 244/* MAX14830 specific */
 245#define MAX14830_BRGCFG_CLKDIS_BIT	(1 << 6) /* Clock Disable */
 246#define MAX14830_REV_ID			(0xb0)
 247
 248struct max310x_devtype {
 249	char	name[9];
 250	int	nr;
 251	int	(*detect)(struct device *);
 252	void	(*power)(struct uart_port *, int);
 253};
 254
 255struct max310x_one {
 256	struct uart_port	port;
 257	struct work_struct	tx_work;
 258	struct work_struct	md_work;
 259	struct work_struct	rs_work;
 260};
 261
 262struct max310x_port {
 263	struct max310x_devtype	*devtype;
 264	struct regmap		*regmap;
 265	struct mutex		mutex;
 266	struct clk		*clk;
 267#ifdef CONFIG_GPIOLIB
 268	struct gpio_chip	gpio;
 269#endif
 270	struct max310x_one	p[0];
 271};
 272
 273static struct uart_driver max310x_uart = {
 274	.owner		= THIS_MODULE,
 275	.driver_name	= MAX310X_NAME,
 276	.dev_name	= "ttyMAX",
 277	.major		= MAX310X_MAJOR,
 278	.minor		= MAX310X_MINOR,
 279	.nr		= MAX310X_UART_NRMAX,
 280};
 281
 282static DECLARE_BITMAP(max310x_lines, MAX310X_UART_NRMAX);
 283
 284static u8 max310x_port_read(struct uart_port *port, u8 reg)
 285{
 286	struct max310x_port *s = dev_get_drvdata(port->dev);
 287	unsigned int val = 0;
 288
 289	regmap_read(s->regmap, port->iobase + reg, &val);
 290
 291	return val;
 292}
 293
 294static void max310x_port_write(struct uart_port *port, u8 reg, u8 val)
 295{
 296	struct max310x_port *s = dev_get_drvdata(port->dev);
 297
 298	regmap_write(s->regmap, port->iobase + reg, val);
 299}
 300
 301static void max310x_port_update(struct uart_port *port, u8 reg, u8 mask, u8 val)
 302{
 303	struct max310x_port *s = dev_get_drvdata(port->dev);
 304
 305	regmap_update_bits(s->regmap, port->iobase + reg, mask, val);
 306}
 307
 308static int max3107_detect(struct device *dev)
 309{
 310	struct max310x_port *s = dev_get_drvdata(dev);
 311	unsigned int val = 0;
 312	int ret;
 313
 314	ret = regmap_read(s->regmap, MAX310X_REVID_REG, &val);
 315	if (ret)
 316		return ret;
 317
 318	if (((val & MAX310x_REV_MASK) != MAX3107_REV_ID)) {
 319		dev_err(dev,
 320			"%s ID 0x%02x does not match\n", s->devtype->name, val);
 321		return -ENODEV;
 322	}
 323
 324	return 0;
 325}
 326
 327static int max3108_detect(struct device *dev)
 328{
 329	struct max310x_port *s = dev_get_drvdata(dev);
 330	unsigned int val = 0;
 331	int ret;
 332
 333	/* MAX3108 have not REV ID register, we just check default value
 334	 * from clocksource register to make sure everything works.
 335	 */
 336	ret = regmap_read(s->regmap, MAX310X_CLKSRC_REG, &val);
 337	if (ret)
 338		return ret;
 339
 340	if (val != (MAX310X_CLKSRC_EXTCLK_BIT | MAX310X_CLKSRC_PLLBYP_BIT)) {
 341		dev_err(dev, "%s not present\n", s->devtype->name);
 342		return -ENODEV;
 343	}
 344
 345	return 0;
 346}
 347
 348static int max3109_detect(struct device *dev)
 349{
 350	struct max310x_port *s = dev_get_drvdata(dev);
 351	unsigned int val = 0;
 352	int ret;
 353
 354	ret = regmap_write(s->regmap, MAX310X_GLOBALCMD_REG,
 355			   MAX310X_EXTREG_ENBL);
 356	if (ret)
 357		return ret;
 358
 359	regmap_read(s->regmap, MAX310X_REVID_EXTREG, &val);
 360	regmap_write(s->regmap, MAX310X_GLOBALCMD_REG, MAX310X_EXTREG_DSBL);
 361	if (((val & MAX310x_REV_MASK) != MAX3109_REV_ID)) {
 362		dev_err(dev,
 363			"%s ID 0x%02x does not match\n", s->devtype->name, val);
 364		return -ENODEV;
 365	}
 366
 367	return 0;
 368}
 369
 370static void max310x_power(struct uart_port *port, int on)
 371{
 372	max310x_port_update(port, MAX310X_MODE1_REG,
 373			    MAX310X_MODE1_FORCESLEEP_BIT,
 374			    on ? 0 : MAX310X_MODE1_FORCESLEEP_BIT);
 375	if (on)
 376		msleep(50);
 377}
 378
 379static int max14830_detect(struct device *dev)
 380{
 381	struct max310x_port *s = dev_get_drvdata(dev);
 382	unsigned int val = 0;
 383	int ret;
 384
 385	ret = regmap_write(s->regmap, MAX310X_GLOBALCMD_REG,
 386			   MAX310X_EXTREG_ENBL);
 387	if (ret)
 388		return ret;
 389	
 390	regmap_read(s->regmap, MAX310X_REVID_EXTREG, &val);
 391	regmap_write(s->regmap, MAX310X_GLOBALCMD_REG, MAX310X_EXTREG_DSBL);
 392	if (((val & MAX310x_REV_MASK) != MAX14830_REV_ID)) {
 393		dev_err(dev,
 394			"%s ID 0x%02x does not match\n", s->devtype->name, val);
 395		return -ENODEV;
 396	}
 397
 398	return 0;
 399}
 400
 401static void max14830_power(struct uart_port *port, int on)
 402{
 403	max310x_port_update(port, MAX310X_BRGCFG_REG,
 404			    MAX14830_BRGCFG_CLKDIS_BIT,
 405			    on ? 0 : MAX14830_BRGCFG_CLKDIS_BIT);
 406	if (on)
 407		msleep(50);
 408}
 409
 410static const struct max310x_devtype max3107_devtype = {
 411	.name	= "MAX3107",
 412	.nr	= 1,
 413	.detect	= max3107_detect,
 414	.power	= max310x_power,
 415};
 416
 417static const struct max310x_devtype max3108_devtype = {
 418	.name	= "MAX3108",
 419	.nr	= 1,
 420	.detect	= max3108_detect,
 421	.power	= max310x_power,
 422};
 423
 424static const struct max310x_devtype max3109_devtype = {
 425	.name	= "MAX3109",
 426	.nr	= 2,
 427	.detect	= max3109_detect,
 428	.power	= max310x_power,
 429};
 430
 431static const struct max310x_devtype max14830_devtype = {
 432	.name	= "MAX14830",
 433	.nr	= 4,
 434	.detect	= max14830_detect,
 435	.power	= max14830_power,
 436};
 437
 438static bool max310x_reg_writeable(struct device *dev, unsigned int reg)
 439{
 440	switch (reg & 0x1f) {
 441	case MAX310X_IRQSTS_REG:
 442	case MAX310X_LSR_IRQSTS_REG:
 443	case MAX310X_SPCHR_IRQSTS_REG:
 444	case MAX310X_STS_IRQSTS_REG:
 445	case MAX310X_TXFIFOLVL_REG:
 446	case MAX310X_RXFIFOLVL_REG:
 447		return false;
 448	default:
 449		break;
 450	}
 451
 452	return true;
 453}
 454
 455static bool max310x_reg_volatile(struct device *dev, unsigned int reg)
 456{
 457	switch (reg & 0x1f) {
 458	case MAX310X_RHR_REG:
 459	case MAX310X_IRQSTS_REG:
 460	case MAX310X_LSR_IRQSTS_REG:
 461	case MAX310X_SPCHR_IRQSTS_REG:
 462	case MAX310X_STS_IRQSTS_REG:
 463	case MAX310X_TXFIFOLVL_REG:
 464	case MAX310X_RXFIFOLVL_REG:
 465	case MAX310X_GPIODATA_REG:
 466	case MAX310X_BRGDIVLSB_REG:
 467	case MAX310X_REG_05:
 468	case MAX310X_REG_1F:
 469		return true;
 470	default:
 471		break;
 472	}
 473
 474	return false;
 475}
 476
 477static bool max310x_reg_precious(struct device *dev, unsigned int reg)
 478{
 479	switch (reg & 0x1f) {
 480	case MAX310X_RHR_REG:
 481	case MAX310X_IRQSTS_REG:
 482	case MAX310X_SPCHR_IRQSTS_REG:
 483	case MAX310X_STS_IRQSTS_REG:
 484		return true;
 485	default:
 486		break;
 487	}
 488
 489	return false;
 490}
 491
 492static int max310x_set_baud(struct uart_port *port, int baud)
 493{
 494	unsigned int mode = 0, clk = port->uartclk, div = clk / baud;
 495
 496	/* Check for minimal value for divider */
 497	if (div < 16)
 498		div = 16;
 499
 500	if (clk % baud && (div / 16) < 0x8000) {
 501		/* Mode x2 */
 502		mode = MAX310X_BRGCFG_2XMODE_BIT;
 503		clk = port->uartclk * 2;
 504		div = clk / baud;
 505
 506		if (clk % baud && (div / 16) < 0x8000) {
 507			/* Mode x4 */
 508			mode = MAX310X_BRGCFG_4XMODE_BIT;
 509			clk = port->uartclk * 4;
 510			div = clk / baud;
 511		}
 512	}
 513
 514	max310x_port_write(port, MAX310X_BRGDIVMSB_REG, (div / 16) >> 8);
 515	max310x_port_write(port, MAX310X_BRGDIVLSB_REG, div / 16);
 516	max310x_port_write(port, MAX310X_BRGCFG_REG, (div % 16) | mode);
 517
 518	return DIV_ROUND_CLOSEST(clk, div);
 519}
 520
 521static int max310x_update_best_err(unsigned long f, long *besterr)
 522{
 523	/* Use baudrate 115200 for calculate error */
 524	long err = f % (115200 * 16);
 525
 526	if ((*besterr < 0) || (*besterr > err)) {
 527		*besterr = err;
 528		return 0;
 529	}
 530
 531	return 1;
 532}
 533
 534static int max310x_set_ref_clk(struct max310x_port *s, unsigned long freq,
 535			       bool xtal)
 536{
 537	unsigned int div, clksrc, pllcfg = 0;
 538	long besterr = -1;
 539	unsigned long fdiv, fmul, bestfreq = freq;
 540
 541	/* First, update error without PLL */
 542	max310x_update_best_err(freq, &besterr);
 543
 544	/* Try all possible PLL dividers */
 545	for (div = 1; (div <= 63) && besterr; div++) {
 546		fdiv = DIV_ROUND_CLOSEST(freq, div);
 547
 548		/* Try multiplier 6 */
 549		fmul = fdiv * 6;
 550		if ((fdiv >= 500000) && (fdiv <= 800000))
 551			if (!max310x_update_best_err(fmul, &besterr)) {
 552				pllcfg = (0 << 6) | div;
 553				bestfreq = fmul;
 554			}
 555		/* Try multiplier 48 */
 556		fmul = fdiv * 48;
 557		if ((fdiv >= 850000) && (fdiv <= 1200000))
 558			if (!max310x_update_best_err(fmul, &besterr)) {
 559				pllcfg = (1 << 6) | div;
 560				bestfreq = fmul;
 561			}
 562		/* Try multiplier 96 */
 563		fmul = fdiv * 96;
 564		if ((fdiv >= 425000) && (fdiv <= 1000000))
 565			if (!max310x_update_best_err(fmul, &besterr)) {
 566				pllcfg = (2 << 6) | div;
 567				bestfreq = fmul;
 568			}
 569		/* Try multiplier 144 */
 570		fmul = fdiv * 144;
 571		if ((fdiv >= 390000) && (fdiv <= 667000))
 572			if (!max310x_update_best_err(fmul, &besterr)) {
 573				pllcfg = (3 << 6) | div;
 574				bestfreq = fmul;
 575			}
 576	}
 577
 578	/* Configure clock source */
 579	clksrc = xtal ? MAX310X_CLKSRC_CRYST_BIT : MAX310X_CLKSRC_EXTCLK_BIT;
 580
 581	/* Configure PLL */
 582	if (pllcfg) {
 583		clksrc |= MAX310X_CLKSRC_PLL_BIT;
 584		regmap_write(s->regmap, MAX310X_PLLCFG_REG, pllcfg);
 585	} else
 586		clksrc |= MAX310X_CLKSRC_PLLBYP_BIT;
 587
 588	regmap_write(s->regmap, MAX310X_CLKSRC_REG, clksrc);
 589
 590	/* Wait for crystal */
 591	if (pllcfg && xtal)
 592		msleep(10);
 593
 594	return (int)bestfreq;
 595}
 596
 597static void max310x_batch_write(struct uart_port *port, u8 *txbuf, unsigned int len)
 598{
 599	u8 header[] = { (port->iobase + MAX310X_THR_REG) | MAX310X_WRITE_BIT };
 600	struct spi_transfer xfer[] = {
 601		{
 602			.tx_buf = &header,
 603			.len = sizeof(header),
 604		}, {
 605			.tx_buf = txbuf,
 606			.len = len,
 607		}
 608	};
 609	spi_sync_transfer(to_spi_device(port->dev), xfer, ARRAY_SIZE(xfer));
 610}
 611
 612static void max310x_batch_read(struct uart_port *port, u8 *rxbuf, unsigned int len)
 613{
 614	u8 header[] = { port->iobase + MAX310X_RHR_REG };
 615	struct spi_transfer xfer[] = {
 616		{
 617			.tx_buf = &header,
 618			.len = sizeof(header),
 619		}, {
 620			.rx_buf = rxbuf,
 621			.len = len,
 622		}
 623	};
 624	spi_sync_transfer(to_spi_device(port->dev), xfer, ARRAY_SIZE(xfer));
 625}
 626
 627static void max310x_handle_rx(struct uart_port *port, unsigned int rxlen)
 628{
 629	unsigned int sts, ch, flag, i;
 630	u8 buf[MAX310X_FIFO_SIZE];
 631
 632	if (port->read_status_mask == MAX310X_LSR_RXOVR_BIT) {
 633		/* We are just reading, happily ignoring any error conditions.
 634		 * Break condition, parity checking, framing errors -- they
 635		 * are all ignored. That means that we can do a batch-read.
 636		 *
 637		 * There is a small opportunity for race if the RX FIFO
 638		 * overruns while we're reading the buffer; the datasheets says
 639		 * that the LSR register applies to the "current" character.
 640		 * That's also the reason why we cannot do batched reads when
 641		 * asked to check the individual statuses.
 642		 * */
 643
 644		sts = max310x_port_read(port, MAX310X_LSR_IRQSTS_REG);
 645		max310x_batch_read(port, buf, rxlen);
 646
 647		port->icount.rx += rxlen;
 648		flag = TTY_NORMAL;
 649		sts &= port->read_status_mask;
 650
 651		if (sts & MAX310X_LSR_RXOVR_BIT) {
 652			dev_warn_ratelimited(port->dev, "Hardware RX FIFO overrun\n");
 653			port->icount.overrun++;
 654		}
 655
 656		for (i = 0; i < rxlen; ++i) {
 657			uart_insert_char(port, sts, MAX310X_LSR_RXOVR_BIT, buf[i], flag);
 658		}
 659
 660	} else {
 661		if (unlikely(rxlen >= port->fifosize)) {
 662			dev_warn_ratelimited(port->dev, "Possible RX FIFO overrun\n");
 663			port->icount.buf_overrun++;
 664			/* Ensure sanity of RX level */
 665			rxlen = port->fifosize;
 666		}
 667
 668		while (rxlen--) {
 669			ch = max310x_port_read(port, MAX310X_RHR_REG);
 670			sts = max310x_port_read(port, MAX310X_LSR_IRQSTS_REG);
 671
 672			sts &= MAX310X_LSR_RXPAR_BIT | MAX310X_LSR_FRERR_BIT |
 673			       MAX310X_LSR_RXOVR_BIT | MAX310X_LSR_RXBRK_BIT;
 674
 675			port->icount.rx++;
 676			flag = TTY_NORMAL;
 677
 678			if (unlikely(sts)) {
 679				if (sts & MAX310X_LSR_RXBRK_BIT) {
 680					port->icount.brk++;
 681					if (uart_handle_break(port))
 682						continue;
 683				} else if (sts & MAX310X_LSR_RXPAR_BIT)
 684					port->icount.parity++;
 685				else if (sts & MAX310X_LSR_FRERR_BIT)
 686					port->icount.frame++;
 687				else if (sts & MAX310X_LSR_RXOVR_BIT)
 688					port->icount.overrun++;
 689
 690				sts &= port->read_status_mask;
 691				if (sts & MAX310X_LSR_RXBRK_BIT)
 692					flag = TTY_BREAK;
 693				else if (sts & MAX310X_LSR_RXPAR_BIT)
 694					flag = TTY_PARITY;
 695				else if (sts & MAX310X_LSR_FRERR_BIT)
 696					flag = TTY_FRAME;
 697				else if (sts & MAX310X_LSR_RXOVR_BIT)
 698					flag = TTY_OVERRUN;
 699			}
 700
 701			if (uart_handle_sysrq_char(port, ch))
 702				continue;
 703
 704			if (sts & port->ignore_status_mask)
 705				continue;
 706
 707			uart_insert_char(port, sts, MAX310X_LSR_RXOVR_BIT, ch, flag);
 708		}
 709	}
 710
 711	tty_flip_buffer_push(&port->state->port);
 712}
 713
 714static void max310x_handle_tx(struct uart_port *port)
 715{
 716	struct circ_buf *xmit = &port->state->xmit;
 717	unsigned int txlen, to_send, until_end;
 718
 719	if (unlikely(port->x_char)) {
 720		max310x_port_write(port, MAX310X_THR_REG, port->x_char);
 721		port->icount.tx++;
 722		port->x_char = 0;
 723		return;
 724	}
 725
 726	if (uart_circ_empty(xmit) || uart_tx_stopped(port))
 727		return;
 728
 729	/* Get length of data pending in circular buffer */
 730	to_send = uart_circ_chars_pending(xmit);
 731	until_end = CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE);
 732	if (likely(to_send)) {
 733		/* Limit to size of TX FIFO */
 734		txlen = max310x_port_read(port, MAX310X_TXFIFOLVL_REG);
 735		txlen = port->fifosize - txlen;
 736		to_send = (to_send > txlen) ? txlen : to_send;
 737
 738		if (until_end < to_send) {
 739			/* It's a circ buffer -- wrap around.
 740			 * We could do that in one SPI transaction, but meh. */
 741			max310x_batch_write(port, xmit->buf + xmit->tail, until_end);
 742			max310x_batch_write(port, xmit->buf, to_send - until_end);
 743		} else {
 744			max310x_batch_write(port, xmit->buf + xmit->tail, to_send);
 745		}
 746
 747		/* Add data to send */
 748		port->icount.tx += to_send;
 749		xmit->tail = (xmit->tail + to_send) & (UART_XMIT_SIZE - 1);
 750	}
 751
 752	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 753		uart_write_wakeup(port);
 754}
 755
 756static void max310x_start_tx(struct uart_port *port)
 757{
 758	struct max310x_one *one = container_of(port, struct max310x_one, port);
 759
 760	if (!work_pending(&one->tx_work))
 761		schedule_work(&one->tx_work);
 762}
 763
 764static irqreturn_t max310x_port_irq(struct max310x_port *s, int portno)
 765{
 766	struct uart_port *port = &s->p[portno].port;
 767	irqreturn_t res = IRQ_NONE;
 768
 769	do {
 770		unsigned int ists, lsr, rxlen;
 771
 772		/* Read IRQ status & RX FIFO level */
 773		ists = max310x_port_read(port, MAX310X_IRQSTS_REG);
 774		rxlen = max310x_port_read(port, MAX310X_RXFIFOLVL_REG);
 775		if (!ists && !rxlen)
 776			break;
 777
 778		res = IRQ_HANDLED;
 779
 780		if (ists & MAX310X_IRQ_CTS_BIT) {
 781			lsr = max310x_port_read(port, MAX310X_LSR_IRQSTS_REG);
 782			uart_handle_cts_change(port,
 783					       !!(lsr & MAX310X_LSR_CTS_BIT));
 784		}
 785		if (rxlen)
 786			max310x_handle_rx(port, rxlen);
 787		if (ists & MAX310X_IRQ_TXEMPTY_BIT)
 788			max310x_start_tx(port);
 789	} while (1);
 790	return res;
 791}
 792
 793static irqreturn_t max310x_ist(int irq, void *dev_id)
 794{
 795	struct max310x_port *s = (struct max310x_port *)dev_id;
 796	bool handled = false;
 797
 798	if (s->devtype->nr > 1) {
 799		do {
 800			unsigned int val = ~0;
 801
 802			WARN_ON_ONCE(regmap_read(s->regmap,
 803						 MAX310X_GLOBALIRQ_REG, &val));
 804			val = ((1 << s->devtype->nr) - 1) & ~val;
 805			if (!val)
 806				break;
 807			if (max310x_port_irq(s, fls(val) - 1) == IRQ_HANDLED)
 808				handled = true;
 809		} while (1);
 810	} else {
 811		if (max310x_port_irq(s, 0) == IRQ_HANDLED)
 812			handled = true;
 813	}
 814
 815	return IRQ_RETVAL(handled);
 816}
 817
 818static void max310x_wq_proc(struct work_struct *ws)
 819{
 820	struct max310x_one *one = container_of(ws, struct max310x_one, tx_work);
 821	struct max310x_port *s = dev_get_drvdata(one->port.dev);
 822
 823	mutex_lock(&s->mutex);
 824	max310x_handle_tx(&one->port);
 825	mutex_unlock(&s->mutex);
 826}
 827
 828static unsigned int max310x_tx_empty(struct uart_port *port)
 829{
 830	unsigned int lvl, sts;
 831
 832	lvl = max310x_port_read(port, MAX310X_TXFIFOLVL_REG);
 833	sts = max310x_port_read(port, MAX310X_IRQSTS_REG);
 834
 835	return ((sts & MAX310X_IRQ_TXEMPTY_BIT) && !lvl) ? TIOCSER_TEMT : 0;
 836}
 837
 838static unsigned int max310x_get_mctrl(struct uart_port *port)
 839{
 840	/* DCD and DSR are not wired and CTS/RTS is handled automatically
 841	 * so just indicate DSR and CAR asserted
 842	 */
 843	return TIOCM_DSR | TIOCM_CAR;
 844}
 845
 846static void max310x_md_proc(struct work_struct *ws)
 847{
 848	struct max310x_one *one = container_of(ws, struct max310x_one, md_work);
 849
 850	max310x_port_update(&one->port, MAX310X_MODE2_REG,
 851			    MAX310X_MODE2_LOOPBACK_BIT,
 852			    (one->port.mctrl & TIOCM_LOOP) ?
 853			    MAX310X_MODE2_LOOPBACK_BIT : 0);
 854}
 855
 856static void max310x_set_mctrl(struct uart_port *port, unsigned int mctrl)
 857{
 858	struct max310x_one *one = container_of(port, struct max310x_one, port);
 859
 860	schedule_work(&one->md_work);
 861}
 862
 863static void max310x_break_ctl(struct uart_port *port, int break_state)
 864{
 865	max310x_port_update(port, MAX310X_LCR_REG,
 866			    MAX310X_LCR_TXBREAK_BIT,
 867			    break_state ? MAX310X_LCR_TXBREAK_BIT : 0);
 868}
 869
 870static void max310x_set_termios(struct uart_port *port,
 871				struct ktermios *termios,
 872				struct ktermios *old)
 873{
 874	unsigned int lcr = 0, flow = 0;
 875	int baud;
 876
 877	/* Mask termios capabilities we don't support */
 878	termios->c_cflag &= ~CMSPAR;
 879
 880	/* Word size */
 881	switch (termios->c_cflag & CSIZE) {
 882	case CS5:
 883		break;
 884	case CS6:
 885		lcr = MAX310X_LCR_LENGTH0_BIT;
 886		break;
 887	case CS7:
 888		lcr = MAX310X_LCR_LENGTH1_BIT;
 889		break;
 890	case CS8:
 891	default:
 892		lcr = MAX310X_LCR_LENGTH1_BIT | MAX310X_LCR_LENGTH0_BIT;
 893		break;
 894	}
 895
 896	/* Parity */
 897	if (termios->c_cflag & PARENB) {
 898		lcr |= MAX310X_LCR_PARITY_BIT;
 899		if (!(termios->c_cflag & PARODD))
 900			lcr |= MAX310X_LCR_EVENPARITY_BIT;
 901	}
 902
 903	/* Stop bits */
 904	if (termios->c_cflag & CSTOPB)
 905		lcr |= MAX310X_LCR_STOPLEN_BIT; /* 2 stops */
 906
 907	/* Update LCR register */
 908	max310x_port_write(port, MAX310X_LCR_REG, lcr);
 909
 910	/* Set read status mask */
 911	port->read_status_mask = MAX310X_LSR_RXOVR_BIT;
 912	if (termios->c_iflag & INPCK)
 913		port->read_status_mask |= MAX310X_LSR_RXPAR_BIT |
 914					  MAX310X_LSR_FRERR_BIT;
 915	if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK))
 916		port->read_status_mask |= MAX310X_LSR_RXBRK_BIT;
 917
 918	/* Set status ignore mask */
 919	port->ignore_status_mask = 0;
 920	if (termios->c_iflag & IGNBRK)
 921		port->ignore_status_mask |= MAX310X_LSR_RXBRK_BIT;
 922	if (!(termios->c_cflag & CREAD))
 923		port->ignore_status_mask |= MAX310X_LSR_RXPAR_BIT |
 924					    MAX310X_LSR_RXOVR_BIT |
 925					    MAX310X_LSR_FRERR_BIT |
 926					    MAX310X_LSR_RXBRK_BIT;
 927
 928	/* Configure flow control */
 929	max310x_port_write(port, MAX310X_XON1_REG, termios->c_cc[VSTART]);
 930	max310x_port_write(port, MAX310X_XOFF1_REG, termios->c_cc[VSTOP]);
 931	if (termios->c_cflag & CRTSCTS)
 932		flow |= MAX310X_FLOWCTRL_AUTOCTS_BIT |
 933			MAX310X_FLOWCTRL_AUTORTS_BIT;
 934	if (termios->c_iflag & IXON)
 935		flow |= MAX310X_FLOWCTRL_SWFLOW3_BIT |
 936			MAX310X_FLOWCTRL_SWFLOWEN_BIT;
 937	if (termios->c_iflag & IXOFF)
 938		flow |= MAX310X_FLOWCTRL_SWFLOW1_BIT |
 939			MAX310X_FLOWCTRL_SWFLOWEN_BIT;
 940	max310x_port_write(port, MAX310X_FLOWCTRL_REG, flow);
 941
 942	/* Get baud rate generator configuration */
 943	baud = uart_get_baud_rate(port, termios, old,
 944				  port->uartclk / 16 / 0xffff,
 945				  port->uartclk / 4);
 946
 947	/* Setup baudrate generator */
 948	baud = max310x_set_baud(port, baud);
 949
 950	/* Update timeout according to new baud rate */
 951	uart_update_timeout(port, termios->c_cflag, baud);
 952}
 953
 954static void max310x_rs_proc(struct work_struct *ws)
 955{
 956	struct max310x_one *one = container_of(ws, struct max310x_one, rs_work);
 957	unsigned int val;
 958
 959	val = (one->port.rs485.delay_rts_before_send << 4) |
 960		one->port.rs485.delay_rts_after_send;
 961	max310x_port_write(&one->port, MAX310X_HDPIXDELAY_REG, val);
 962
 963	if (one->port.rs485.flags & SER_RS485_ENABLED) {
 964		max310x_port_update(&one->port, MAX310X_MODE1_REG,
 965				MAX310X_MODE1_TRNSCVCTRL_BIT,
 966				MAX310X_MODE1_TRNSCVCTRL_BIT);
 967		max310x_port_update(&one->port, MAX310X_MODE2_REG,
 968				MAX310X_MODE2_ECHOSUPR_BIT,
 969				MAX310X_MODE2_ECHOSUPR_BIT);
 970	} else {
 971		max310x_port_update(&one->port, MAX310X_MODE1_REG,
 972				MAX310X_MODE1_TRNSCVCTRL_BIT, 0);
 973		max310x_port_update(&one->port, MAX310X_MODE2_REG,
 974				MAX310X_MODE2_ECHOSUPR_BIT, 0);
 975	}
 976}
 977
 978static int max310x_rs485_config(struct uart_port *port,
 979				struct serial_rs485 *rs485)
 980{
 981	struct max310x_one *one = container_of(port, struct max310x_one, port);
 982
 983	if ((rs485->delay_rts_before_send > 0x0f) ||
 984	    (rs485->delay_rts_after_send > 0x0f))
 985		return -ERANGE;
 986
 987	rs485->flags &= SER_RS485_RTS_ON_SEND | SER_RS485_ENABLED;
 988	memset(rs485->padding, 0, sizeof(rs485->padding));
 989	port->rs485 = *rs485;
 990
 991	schedule_work(&one->rs_work);
 992
 993	return 0;
 994}
 995
 996static int max310x_startup(struct uart_port *port)
 997{
 998	struct max310x_port *s = dev_get_drvdata(port->dev);
 999	unsigned int val;
1000
1001	s->devtype->power(port, 1);
1002
1003	/* Configure MODE1 register */
1004	max310x_port_update(port, MAX310X_MODE1_REG,
1005			    MAX310X_MODE1_TRNSCVCTRL_BIT, 0);
1006
1007	/* Configure MODE2 register & Reset FIFOs*/
1008	val = MAX310X_MODE2_RXEMPTINV_BIT | MAX310X_MODE2_FIFORST_BIT;
1009	max310x_port_write(port, MAX310X_MODE2_REG, val);
1010	max310x_port_update(port, MAX310X_MODE2_REG,
1011			    MAX310X_MODE2_FIFORST_BIT, 0);
1012
1013	/* Configure flow control levels */
1014	/* Flow control halt level 96, resume level 48 */
1015	max310x_port_write(port, MAX310X_FLOWLVL_REG,
1016			   MAX310X_FLOWLVL_RES(48) | MAX310X_FLOWLVL_HALT(96));
1017
1018	/* Clear IRQ status register */
1019	max310x_port_read(port, MAX310X_IRQSTS_REG);
1020
1021	/* Enable RX, TX, CTS change interrupts */
1022	val = MAX310X_IRQ_RXEMPTY_BIT | MAX310X_IRQ_TXEMPTY_BIT;
1023	max310x_port_write(port, MAX310X_IRQEN_REG, val | MAX310X_IRQ_CTS_BIT);
1024
1025	return 0;
1026}
1027
1028static void max310x_shutdown(struct uart_port *port)
1029{
1030	struct max310x_port *s = dev_get_drvdata(port->dev);
1031
1032	/* Disable all interrupts */
1033	max310x_port_write(port, MAX310X_IRQEN_REG, 0);
1034
1035	s->devtype->power(port, 0);
1036}
1037
1038static const char *max310x_type(struct uart_port *port)
1039{
1040	struct max310x_port *s = dev_get_drvdata(port->dev);
1041
1042	return (port->type == PORT_MAX310X) ? s->devtype->name : NULL;
1043}
1044
1045static int max310x_request_port(struct uart_port *port)
1046{
1047	/* Do nothing */
1048	return 0;
1049}
1050
1051static void max310x_config_port(struct uart_port *port, int flags)
1052{
1053	if (flags & UART_CONFIG_TYPE)
1054		port->type = PORT_MAX310X;
1055}
1056
1057static int max310x_verify_port(struct uart_port *port, struct serial_struct *s)
1058{
1059	if ((s->type != PORT_UNKNOWN) && (s->type != PORT_MAX310X))
1060		return -EINVAL;
1061	if (s->irq != port->irq)
1062		return -EINVAL;
1063
1064	return 0;
1065}
1066
1067static void max310x_null_void(struct uart_port *port)
1068{
1069	/* Do nothing */
1070}
1071
1072static const struct uart_ops max310x_ops = {
1073	.tx_empty	= max310x_tx_empty,
1074	.set_mctrl	= max310x_set_mctrl,
1075	.get_mctrl	= max310x_get_mctrl,
1076	.stop_tx	= max310x_null_void,
1077	.start_tx	= max310x_start_tx,
1078	.stop_rx	= max310x_null_void,
1079	.break_ctl	= max310x_break_ctl,
1080	.startup	= max310x_startup,
1081	.shutdown	= max310x_shutdown,
1082	.set_termios	= max310x_set_termios,
1083	.type		= max310x_type,
1084	.request_port	= max310x_request_port,
1085	.release_port	= max310x_null_void,
1086	.config_port	= max310x_config_port,
1087	.verify_port	= max310x_verify_port,
1088};
1089
1090static int __maybe_unused max310x_suspend(struct device *dev)
1091{
1092	struct max310x_port *s = dev_get_drvdata(dev);
1093	int i;
1094
1095	for (i = 0; i < s->devtype->nr; i++) {
1096		uart_suspend_port(&max310x_uart, &s->p[i].port);
1097		s->devtype->power(&s->p[i].port, 0);
1098	}
1099
1100	return 0;
1101}
1102
1103static int __maybe_unused max310x_resume(struct device *dev)
1104{
1105	struct max310x_port *s = dev_get_drvdata(dev);
1106	int i;
1107
1108	for (i = 0; i < s->devtype->nr; i++) {
1109		s->devtype->power(&s->p[i].port, 1);
1110		uart_resume_port(&max310x_uart, &s->p[i].port);
1111	}
1112
1113	return 0;
1114}
1115
1116static SIMPLE_DEV_PM_OPS(max310x_pm_ops, max310x_suspend, max310x_resume);
1117
1118#ifdef CONFIG_GPIOLIB
1119static int max310x_gpio_get(struct gpio_chip *chip, unsigned offset)
1120{
1121	unsigned int val;
1122	struct max310x_port *s = gpiochip_get_data(chip);
1123	struct uart_port *port = &s->p[offset / 4].port;
1124
1125	val = max310x_port_read(port, MAX310X_GPIODATA_REG);
1126
1127	return !!((val >> 4) & (1 << (offset % 4)));
1128}
1129
1130static void max310x_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
1131{
1132	struct max310x_port *s = gpiochip_get_data(chip);
1133	struct uart_port *port = &s->p[offset / 4].port;
1134
1135	max310x_port_update(port, MAX310X_GPIODATA_REG, 1 << (offset % 4),
1136			    value ? 1 << (offset % 4) : 0);
1137}
1138
1139static int max310x_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
1140{
1141	struct max310x_port *s = gpiochip_get_data(chip);
1142	struct uart_port *port = &s->p[offset / 4].port;
1143
1144	max310x_port_update(port, MAX310X_GPIOCFG_REG, 1 << (offset % 4), 0);
1145
1146	return 0;
1147}
1148
1149static int max310x_gpio_direction_output(struct gpio_chip *chip,
1150					 unsigned offset, int value)
1151{
1152	struct max310x_port *s = gpiochip_get_data(chip);
1153	struct uart_port *port = &s->p[offset / 4].port;
1154
1155	max310x_port_update(port, MAX310X_GPIODATA_REG, 1 << (offset % 4),
1156			    value ? 1 << (offset % 4) : 0);
1157	max310x_port_update(port, MAX310X_GPIOCFG_REG, 1 << (offset % 4),
1158			    1 << (offset % 4));
1159
1160	return 0;
1161}
1162
1163static int max310x_gpio_set_config(struct gpio_chip *chip, unsigned int offset,
1164				   unsigned long config)
1165{
1166	struct max310x_port *s = gpiochip_get_data(chip);
1167	struct uart_port *port = &s->p[offset / 4].port;
1168
1169	switch (pinconf_to_config_param(config)) {
1170	case PIN_CONFIG_DRIVE_OPEN_DRAIN:
1171		max310x_port_update(port, MAX310X_GPIOCFG_REG,
1172				1 << ((offset % 4) + 4),
1173				1 << ((offset % 4) + 4));
1174		return 0;
1175	case PIN_CONFIG_DRIVE_PUSH_PULL:
1176		max310x_port_update(port, MAX310X_GPIOCFG_REG,
1177				1 << ((offset % 4) + 4), 0);
1178		return 0;
1179	default:
1180		return -ENOTSUPP;
1181	}
1182}
1183#endif
1184
1185static int max310x_probe(struct device *dev, struct max310x_devtype *devtype,
1186			 struct regmap *regmap, int irq)
1187{
1188	int i, ret, fmin, fmax, freq, uartclk;
1189	struct clk *clk_osc, *clk_xtal;
1190	struct max310x_port *s;
1191	bool xtal = false;
1192
1193	if (IS_ERR(regmap))
1194		return PTR_ERR(regmap);
1195
1196	/* Alloc port structure */
1197	s = devm_kzalloc(dev, sizeof(*s) +
1198			 sizeof(struct max310x_one) * devtype->nr, GFP_KERNEL);
1199	if (!s) {
1200		dev_err(dev, "Error allocating port structure\n");
1201		return -ENOMEM;
1202	}
1203
1204	clk_osc = devm_clk_get(dev, "osc");
1205	clk_xtal = devm_clk_get(dev, "xtal");
1206	if (!IS_ERR(clk_osc)) {
1207		s->clk = clk_osc;
1208		fmin = 500000;
1209		fmax = 35000000;
1210	} else if (!IS_ERR(clk_xtal)) {
1211		s->clk = clk_xtal;
1212		fmin = 1000000;
1213		fmax = 4000000;
1214		xtal = true;
1215	} else if (PTR_ERR(clk_osc) == -EPROBE_DEFER ||
1216		   PTR_ERR(clk_xtal) == -EPROBE_DEFER) {
1217		return -EPROBE_DEFER;
1218	} else {
1219		dev_err(dev, "Cannot get clock\n");
1220		return -EINVAL;
1221	}
1222
1223	ret = clk_prepare_enable(s->clk);
1224	if (ret)
1225		return ret;
1226
1227	freq = clk_get_rate(s->clk);
1228	/* Check frequency limits */
1229	if (freq < fmin || freq > fmax) {
1230		ret = -ERANGE;
1231		goto out_clk;
1232	}
1233
1234	s->regmap = regmap;
1235	s->devtype = devtype;
1236	dev_set_drvdata(dev, s);
1237
1238	/* Check device to ensure we are talking to what we expect */
1239	ret = devtype->detect(dev);
1240	if (ret)
1241		goto out_clk;
1242
1243	for (i = 0; i < devtype->nr; i++) {
1244		unsigned int offs = i << 5;
1245
1246		/* Reset port */
1247		regmap_write(s->regmap, MAX310X_MODE2_REG + offs,
1248			     MAX310X_MODE2_RST_BIT);
1249		/* Clear port reset */
1250		regmap_write(s->regmap, MAX310X_MODE2_REG + offs, 0);
1251
1252		/* Wait for port startup */
1253		do {
1254			regmap_read(s->regmap,
1255				    MAX310X_BRGDIVLSB_REG + offs, &ret);
1256		} while (ret != 0x01);
1257
1258		regmap_update_bits(s->regmap, MAX310X_MODE1_REG + offs,
1259				   MAX310X_MODE1_AUTOSLEEP_BIT,
1260				   MAX310X_MODE1_AUTOSLEEP_BIT);
1261	}
1262
1263	uartclk = max310x_set_ref_clk(s, freq, xtal);
1264	dev_dbg(dev, "Reference clock set to %i Hz\n", uartclk);
1265
1266	mutex_init(&s->mutex);
1267
1268	for (i = 0; i < devtype->nr; i++) {
1269		unsigned int line;
1270
1271		line = find_first_zero_bit(max310x_lines, MAX310X_UART_NRMAX);
1272		if (line == MAX310X_UART_NRMAX) {
1273			ret = -ERANGE;
1274			goto out_uart;
1275		}
1276
1277		/* Initialize port data */
1278		s->p[i].port.line	= line;
1279		s->p[i].port.dev	= dev;
1280		s->p[i].port.irq	= irq;
1281		s->p[i].port.type	= PORT_MAX310X;
1282		s->p[i].port.fifosize	= MAX310X_FIFO_SIZE;
1283		s->p[i].port.flags	= UPF_FIXED_TYPE | UPF_LOW_LATENCY;
1284		s->p[i].port.iotype	= UPIO_PORT;
1285		s->p[i].port.iobase	= i * 0x20;
1286		s->p[i].port.membase	= (void __iomem *)~0;
1287		s->p[i].port.uartclk	= uartclk;
1288		s->p[i].port.rs485_config = max310x_rs485_config;
1289		s->p[i].port.ops	= &max310x_ops;
1290		/* Disable all interrupts */
1291		max310x_port_write(&s->p[i].port, MAX310X_IRQEN_REG, 0);
1292		/* Clear IRQ status register */
1293		max310x_port_read(&s->p[i].port, MAX310X_IRQSTS_REG);
1294		/* Enable IRQ pin */
1295		max310x_port_update(&s->p[i].port, MAX310X_MODE1_REG,
1296				    MAX310X_MODE1_IRQSEL_BIT,
1297				    MAX310X_MODE1_IRQSEL_BIT);
1298		/* Initialize queue for start TX */
1299		INIT_WORK(&s->p[i].tx_work, max310x_wq_proc);
1300		/* Initialize queue for changing LOOPBACK mode */
1301		INIT_WORK(&s->p[i].md_work, max310x_md_proc);
1302		/* Initialize queue for changing RS485 mode */
1303		INIT_WORK(&s->p[i].rs_work, max310x_rs_proc);
1304
1305		/* Register port */
1306		ret = uart_add_one_port(&max310x_uart, &s->p[i].port);
1307		if (ret) {
1308			s->p[i].port.dev = NULL;
1309			goto out_uart;
1310		}
1311		set_bit(line, max310x_lines);
1312
1313		/* Go to suspend mode */
1314		devtype->power(&s->p[i].port, 0);
1315	}
1316
1317#ifdef CONFIG_GPIOLIB
1318	/* Setup GPIO cotroller */
1319	s->gpio.owner		= THIS_MODULE;
1320	s->gpio.parent		= dev;
1321	s->gpio.label		= devtype->name;
1322	s->gpio.direction_input	= max310x_gpio_direction_input;
1323	s->gpio.get		= max310x_gpio_get;
1324	s->gpio.direction_output= max310x_gpio_direction_output;
1325	s->gpio.set		= max310x_gpio_set;
1326	s->gpio.set_config	= max310x_gpio_set_config;
1327	s->gpio.base		= -1;
1328	s->gpio.ngpio		= devtype->nr * 4;
1329	s->gpio.can_sleep	= 1;
1330	ret = devm_gpiochip_add_data(dev, &s->gpio, s);
1331	if (ret)
1332		goto out_uart;
1333#endif
1334
1335	/* Setup interrupt */
1336	ret = devm_request_threaded_irq(dev, irq, NULL, max310x_ist,
1337					IRQF_ONESHOT | IRQF_SHARED, dev_name(dev), s);
1338	if (!ret)
1339		return 0;
1340
1341	dev_err(dev, "Unable to reguest IRQ %i\n", irq);
1342
1343out_uart:
1344	for (i = 0; i < devtype->nr; i++) {
1345		if (s->p[i].port.dev) {
1346			uart_remove_one_port(&max310x_uart, &s->p[i].port);
1347			clear_bit(s->p[i].port.line, max310x_lines);
1348		}
1349	}
1350
1351	mutex_destroy(&s->mutex);
1352
1353out_clk:
1354	clk_disable_unprepare(s->clk);
1355
1356	return ret;
1357}
1358
1359static int max310x_remove(struct device *dev)
1360{
1361	struct max310x_port *s = dev_get_drvdata(dev);
1362	int i;
1363
1364	for (i = 0; i < s->devtype->nr; i++) {
1365		cancel_work_sync(&s->p[i].tx_work);
1366		cancel_work_sync(&s->p[i].md_work);
1367		cancel_work_sync(&s->p[i].rs_work);
1368		uart_remove_one_port(&max310x_uart, &s->p[i].port);
1369		clear_bit(s->p[i].port.line, max310x_lines);
1370		s->devtype->power(&s->p[i].port, 0);
1371	}
1372
1373	mutex_destroy(&s->mutex);
1374	clk_disable_unprepare(s->clk);
1375
1376	return 0;
1377}
1378
1379static const struct of_device_id __maybe_unused max310x_dt_ids[] = {
1380	{ .compatible = "maxim,max3107",	.data = &max3107_devtype, },
1381	{ .compatible = "maxim,max3108",	.data = &max3108_devtype, },
1382	{ .compatible = "maxim,max3109",	.data = &max3109_devtype, },
1383	{ .compatible = "maxim,max14830",	.data = &max14830_devtype },
1384	{ }
1385};
1386MODULE_DEVICE_TABLE(of, max310x_dt_ids);
1387
1388static struct regmap_config regcfg = {
1389	.reg_bits = 8,
1390	.val_bits = 8,
1391	.write_flag_mask = MAX310X_WRITE_BIT,
1392	.cache_type = REGCACHE_RBTREE,
1393	.writeable_reg = max310x_reg_writeable,
1394	.volatile_reg = max310x_reg_volatile,
1395	.precious_reg = max310x_reg_precious,
1396};
1397
1398#ifdef CONFIG_SPI_MASTER
1399static int max310x_spi_probe(struct spi_device *spi)
1400{
1401	struct max310x_devtype *devtype;
1402	struct regmap *regmap;
1403	int ret;
1404
1405	/* Setup SPI bus */
1406	spi->bits_per_word	= 8;
1407	spi->mode		= spi->mode ? : SPI_MODE_0;
1408	spi->max_speed_hz	= spi->max_speed_hz ? : 26000000;
1409	ret = spi_setup(spi);
1410	if (ret)
1411		return ret;
1412
1413	if (spi->dev.of_node) {
1414		const struct of_device_id *of_id =
1415			of_match_device(max310x_dt_ids, &spi->dev);
1416
1417		devtype = (struct max310x_devtype *)of_id->data;
1418	} else {
1419		const struct spi_device_id *id_entry = spi_get_device_id(spi);
1420
1421		devtype = (struct max310x_devtype *)id_entry->driver_data;
1422	}
1423
1424	regcfg.max_register = devtype->nr * 0x20 - 1;
1425	regmap = devm_regmap_init_spi(spi, &regcfg);
1426
1427	return max310x_probe(&spi->dev, devtype, regmap, spi->irq);
1428}
1429
1430static int max310x_spi_remove(struct spi_device *spi)
1431{
1432	return max310x_remove(&spi->dev);
1433}
1434
1435static const struct spi_device_id max310x_id_table[] = {
1436	{ "max3107",	(kernel_ulong_t)&max3107_devtype, },
1437	{ "max3108",	(kernel_ulong_t)&max3108_devtype, },
1438	{ "max3109",	(kernel_ulong_t)&max3109_devtype, },
1439	{ "max14830",	(kernel_ulong_t)&max14830_devtype, },
1440	{ }
1441};
1442MODULE_DEVICE_TABLE(spi, max310x_id_table);
1443
1444static struct spi_driver max310x_spi_driver = {
1445	.driver = {
1446		.name		= MAX310X_NAME,
1447		.of_match_table	= of_match_ptr(max310x_dt_ids),
1448		.pm		= &max310x_pm_ops,
1449	},
1450	.probe		= max310x_spi_probe,
1451	.remove		= max310x_spi_remove,
1452	.id_table	= max310x_id_table,
1453};
1454#endif
1455
1456static int __init max310x_uart_init(void)
1457{
1458	int ret;
1459
1460	bitmap_zero(max310x_lines, MAX310X_UART_NRMAX);
1461
1462	ret = uart_register_driver(&max310x_uart);
1463	if (ret)
1464		return ret;
1465
1466#ifdef CONFIG_SPI_MASTER
1467	spi_register_driver(&max310x_spi_driver);
1468#endif
1469
1470	return 0;
1471}
1472module_init(max310x_uart_init);
1473
1474static void __exit max310x_uart_exit(void)
1475{
1476#ifdef CONFIG_SPI_MASTER
1477	spi_unregister_driver(&max310x_spi_driver);
1478#endif
1479
1480	uart_unregister_driver(&max310x_uart);
1481}
1482module_exit(max310x_uart_exit);
1483
1484MODULE_LICENSE("GPL");
1485MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
1486MODULE_DESCRIPTION("MAX310X serial driver");