1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
298af34f8SBin Meng /*
398af34f8SBin Meng * Copyright (C) 2016, Bin Meng <bmeng.cn@gmail.com>
498af34f8SBin Meng */
598af34f8SBin Meng
698af34f8SBin Meng #include <common.h>
798af34f8SBin Meng #include <asm/io.h>
898af34f8SBin Meng #include <errno.h>
998af34f8SBin Meng #include <smsc_sio1007.h>
1098af34f8SBin Meng
sio1007_read(int port,int reg)1198af34f8SBin Meng static inline u8 sio1007_read(int port, int reg)
1298af34f8SBin Meng {
1398af34f8SBin Meng outb(reg, port);
1498af34f8SBin Meng
1598af34f8SBin Meng return inb(port + 1);
1698af34f8SBin Meng }
1798af34f8SBin Meng
sio1007_write(int port,int reg,int val)1898af34f8SBin Meng static inline void sio1007_write(int port, int reg, int val)
1998af34f8SBin Meng {
2098af34f8SBin Meng outb(reg, port);
2198af34f8SBin Meng outb(val, port + 1);
2298af34f8SBin Meng }
2398af34f8SBin Meng
sio1007_clrsetbits(int port,int reg,u8 clr,u8 set)2498af34f8SBin Meng static inline void sio1007_clrsetbits(int port, int reg, u8 clr, u8 set)
2598af34f8SBin Meng {
2698af34f8SBin Meng sio1007_write(port, reg, (sio1007_read(port, reg) & ~clr) | set);
2798af34f8SBin Meng }
2898af34f8SBin Meng
sio1007_enable_serial(int port,int num,int iobase,int irq)2998af34f8SBin Meng void sio1007_enable_serial(int port, int num, int iobase, int irq)
3098af34f8SBin Meng {
3198af34f8SBin Meng if (num < 0 || num > SIO1007_UART_NUM)
3298af34f8SBin Meng return;
3398af34f8SBin Meng
3498af34f8SBin Meng /* enter configuration state */
3598af34f8SBin Meng outb(0x55, port);
3698af34f8SBin Meng
3798af34f8SBin Meng /* power on serial port and set up its i/o base & irq */
3898af34f8SBin Meng if (!num) {
3998af34f8SBin Meng sio1007_clrsetbits(port, DEV_POWER_CTRL, 0, UART1_POWER_ON);
4098af34f8SBin Meng sio1007_clrsetbits(port, UART1_IOBASE, 0xfe, iobase >> 2);
4198af34f8SBin Meng sio1007_clrsetbits(port, UART_IRQ, 0xf0, irq << 4);
4298af34f8SBin Meng } else {
4398af34f8SBin Meng sio1007_clrsetbits(port, DEV_POWER_CTRL, 0, UART2_POWER_ON);
4498af34f8SBin Meng sio1007_clrsetbits(port, UART2_IOBASE, 0xfe, iobase >> 2);
4598af34f8SBin Meng sio1007_clrsetbits(port, UART_IRQ, 0x0f, irq);
4698af34f8SBin Meng }
4798af34f8SBin Meng
4898af34f8SBin Meng /* exit configuration state */
4998af34f8SBin Meng outb(0xaa, port);
5098af34f8SBin Meng }
5198af34f8SBin Meng
sio1007_enable_runtime(int port,int iobase)5298af34f8SBin Meng void sio1007_enable_runtime(int port, int iobase)
5398af34f8SBin Meng {
5498af34f8SBin Meng /* enter configuration state */
5598af34f8SBin Meng outb(0x55, port);
5698af34f8SBin Meng
5798af34f8SBin Meng /* set i/o base for the runtime register block */
5898af34f8SBin Meng sio1007_clrsetbits(port, RTR_IOBASE_LOW, 0, iobase >> 4);
5998af34f8SBin Meng sio1007_clrsetbits(port, RTR_IOBASE_HIGH, 0, iobase >> 12);
6098af34f8SBin Meng /* turn on address decoding for this block */
6198af34f8SBin Meng sio1007_clrsetbits(port, DEV_ACTIVATE, 0, RTR_EN);
6298af34f8SBin Meng
6398af34f8SBin Meng /* exit configuration state */
6498af34f8SBin Meng outb(0xaa, port);
6598af34f8SBin Meng }
6698af34f8SBin Meng
sio1007_gpio_config(int port,int gpio,int dir,int pol,int type)6798af34f8SBin Meng void sio1007_gpio_config(int port, int gpio, int dir, int pol, int type)
6898af34f8SBin Meng {
6998af34f8SBin Meng int reg = GPIO0_DIR;
7098af34f8SBin Meng
7198af34f8SBin Meng if (gpio < 0 || gpio > SIO1007_GPIO_NUM)
7298af34f8SBin Meng return;
7398af34f8SBin Meng if (gpio >= GPIO_NUM_PER_GROUP) {
7498af34f8SBin Meng reg = GPIO1_DIR;
7598af34f8SBin Meng gpio -= GPIO_NUM_PER_GROUP;
7698af34f8SBin Meng }
7798af34f8SBin Meng
7898af34f8SBin Meng /* enter configuration state */
7998af34f8SBin Meng outb(0x55, port);
8098af34f8SBin Meng
8198af34f8SBin Meng /* set gpio pin direction, polority and type */
8298af34f8SBin Meng sio1007_clrsetbits(port, reg, 1 << gpio, dir << gpio);
8398af34f8SBin Meng sio1007_clrsetbits(port, reg + 1, 1 << gpio, pol << gpio);
8498af34f8SBin Meng sio1007_clrsetbits(port, reg + 2, 1 << gpio, type << gpio);
8598af34f8SBin Meng
8698af34f8SBin Meng /* exit configuration state */
8798af34f8SBin Meng outb(0xaa, port);
8898af34f8SBin Meng }
8998af34f8SBin Meng
sio1007_gpio_get_value(int port,int gpio)9098af34f8SBin Meng int sio1007_gpio_get_value(int port, int gpio)
9198af34f8SBin Meng {
9298af34f8SBin Meng int reg = GPIO0_DATA;
9398af34f8SBin Meng int val;
9498af34f8SBin Meng
9598af34f8SBin Meng if (gpio < 0 || gpio > SIO1007_GPIO_NUM)
9698af34f8SBin Meng return -EINVAL;
9798af34f8SBin Meng if (gpio >= GPIO_NUM_PER_GROUP) {
9898af34f8SBin Meng reg = GPIO1_DATA;
9998af34f8SBin Meng gpio -= GPIO_NUM_PER_GROUP;
10098af34f8SBin Meng }
10198af34f8SBin Meng
10298af34f8SBin Meng val = inb(port + reg);
10398af34f8SBin Meng if (val & (1 << gpio))
10498af34f8SBin Meng return 1;
10598af34f8SBin Meng else
10698af34f8SBin Meng return 0;
10798af34f8SBin Meng }
10898af34f8SBin Meng
sio1007_gpio_set_value(int port,int gpio,int val)10998af34f8SBin Meng void sio1007_gpio_set_value(int port, int gpio, int val)
11098af34f8SBin Meng {
11198af34f8SBin Meng int reg = GPIO0_DATA;
11298af34f8SBin Meng u8 data;
11398af34f8SBin Meng
11498af34f8SBin Meng if (gpio < 0 || gpio > SIO1007_GPIO_NUM)
11598af34f8SBin Meng return;
11698af34f8SBin Meng if (gpio >= GPIO_NUM_PER_GROUP) {
11798af34f8SBin Meng reg = GPIO1_DATA;
11898af34f8SBin Meng gpio -= GPIO_NUM_PER_GROUP;
11998af34f8SBin Meng }
12098af34f8SBin Meng
12198af34f8SBin Meng data = inb(port + reg);
12298af34f8SBin Meng data &= ~(1 << gpio);
12398af34f8SBin Meng data |= (val << gpio);
12498af34f8SBin Meng outb(data, port + reg);
12598af34f8SBin Meng }
126