spi: mpc8xxx: Make code more readable
[platform/kernel/u-boot.git] / drivers / spi / mpc8xxx_spi.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2006 Ben Warren, Qstreams Networks Inc.
4  * With help from the common/soft_spi and arch/powerpc/cpu/mpc8260 drivers
5  */
6
7 #include <common.h>
8
9 #include <malloc.h>
10 #include <spi.h>
11 #include <asm/mpc8xxx_spi.h>
12
13 enum {
14         SPI_EV_NE = BIT(31 - 22),       /* Receiver Not Empty */
15         SPI_EV_NF = BIT(31 - 23),       /* Transmitter Not Full */
16 };
17
18 enum {
19         SPI_MODE_LOOP  = BIT(31 - 1),   /* Loopback mode */
20         SPI_MODE_CI    = BIT(31 - 2),   /* Clock invert */
21         SPI_MODE_CP    = BIT(31 - 3),   /* Clock phase */
22         SPI_MODE_DIV16 = BIT(31 - 4),   /* Divide clock source by 16 */
23         SPI_MODE_REV   = BIT(31 - 5),   /* Reverse mode - MSB first */
24         SPI_MODE_MS    = BIT(31 - 6),   /* Always master */
25         SPI_MODE_EN    = BIT(31 - 7),   /* Enable interface */
26
27         SPI_MODE_LEN_MASK = 0xf00000,
28         SPI_MODE_PM_MASK = 0xf0000,
29
30         SPI_COM_LST = BIT(31 - 9),
31 };
32
33 static inline u32 to_prescale_mod(u32 val)
34 {
35         return (min(val, (u32)15) << 16);
36 }
37
38 static void set_char_len(spi8xxx_t *spi, u32 val)
39 {
40         clrsetbits_be32(&spi->mode, SPI_MODE_LEN_MASK, (val << 20));
41 }
42
43 #define SPI_TIMEOUT     1000
44
45 struct spi_slave *spi_setup_slave(uint bus, uint cs, uint max_hz, uint mode)
46 {
47         struct spi_slave *slave;
48
49         if (!spi_cs_is_valid(bus, cs))
50                 return NULL;
51
52         slave = spi_alloc_slave_base(bus, cs);
53         if (!slave)
54                 return NULL;
55
56         /*
57          * TODO: Some of the code in spi_init() should probably move
58          * here, or into spi_claim_bus() below.
59          */
60
61         return slave;
62 }
63
64 void spi_free_slave(struct spi_slave *slave)
65 {
66         free(slave);
67 }
68
69 void spi_init(void)
70 {
71         spi8xxx_t *spi = &((immap_t *)(CONFIG_SYS_IMMR))->spi;
72
73         /*
74          * SPI pins on the MPC83xx are not muxed, so all we do is initialize
75          * some registers
76          */
77         out_be32(&spi->mode, SPI_MODE_REV | SPI_MODE_MS | SPI_MODE_EN);
78         /* Use SYSCLK / 8 (16.67MHz typ.) */
79         clrsetbits_be32(&spi->mode, SPI_MODE_PM_MASK, to_prescale_mod(1));
80         /* Clear all SPI events */
81         setbits_be32(&spi->event, 0xffffffff);
82         /* Mask  all SPI interrupts */
83         clrbits_be32(&spi->mask, 0xffffffff);
84         /* LST bit doesn't do anything, so disregard */
85         out_be32(&spi->com, 0);
86 }
87
88 int spi_claim_bus(struct spi_slave *slave)
89 {
90         return 0;
91 }
92
93 void spi_release_bus(struct spi_slave *slave)
94 {
95 }
96
97 int spi_xfer(struct spi_slave *slave, uint bitlen, const void *dout, void *din,
98              ulong flags)
99 {
100         spi8xxx_t *spi = &((immap_t *)(CONFIG_SYS_IMMR))->spi;
101         u32 tmpdin;
102         int num_blks = DIV_ROUND_UP(bitlen, 32);
103
104         debug("%s: slave %u:%u dout %08X din %08X bitlen %u\n", __func__,
105               slave->bus, slave->cs, *(uint *)dout, *(uint *)din, bitlen);
106
107         if (flags & SPI_XFER_BEGIN)
108                 spi_cs_activate(slave);
109
110         /* Clear all SPI events */
111         setbits_be32(&spi->event, 0xffffffff);
112
113         /* Handle data in 32-bit chunks */
114         while (num_blks--) {
115                 int tm;
116                 u32 tmpdout = 0;
117                 uchar char_size = (bitlen >= 32 ? 32 : bitlen);
118
119                 /* Shift data so it's msb-justified */
120                 tmpdout = *(u32 *)dout >> (32 - char_size);
121
122                 /* The LEN field of the SPMODE register is set as follows:
123                  *
124                  * Bit length             setting
125                  * len <= 4               3
126                  * 4 < len <= 16          len - 1
127                  * len > 16               0
128                  */
129
130                 clrbits_be32(&spi->mode, SPI_MODE_EN);
131
132                 if (bitlen <= 4)
133                         set_char_len(spi, 3);
134                 else if (bitlen <= 16)
135                         set_char_len(spi, bitlen - 1);
136                 else
137                         set_char_len(spi, 0);
138
139                 if (bitlen > 16) {
140                         /* Set up the next iteration if sending > 32 bits */
141                         bitlen -= 32;
142                         dout += 4;
143                 }
144
145                 setbits_be32(&spi->mode, SPI_MODE_EN);
146
147                 /* Write the data out */
148                 out_be32(&spi->tx, tmpdout);
149
150                 debug("*** %s: ... %08x written\n", __func__, tmpdout);
151
152                 /*
153                  * Wait for SPI transmit to get out
154                  * or time out (1 second = 1000 ms)
155                  * The NE event must be read and cleared first
156                  */
157                 for (tm = 0; tm < SPI_TIMEOUT; ++tm) {
158                         u32 event = in_be32(&spi->event);
159                         bool have_ne = event & SPI_EV_NE;
160                         bool have_nf = event & SPI_EV_NF;
161
162                         if (!have_ne)
163                                 continue;
164
165                         tmpdin = in_be32(&spi->rx);
166                         setbits_be32(&spi->event, SPI_EV_NE);
167
168                         *(u32 *)din = (tmpdin << (32 - char_size));
169                         if (char_size == 32) {
170                                 /* Advance output buffer by 32 bits */
171                                 din += 4;
172                         }
173
174                         /*
175                          * Only bail when we've had both NE and NF events.
176                          * This will cause timeouts on RO devices, so maybe
177                          * in the future put an arbitrary delay after writing
178                          * the device.  Arbitrary delays suck, though...
179                          */
180                         if (have_nf)
181                                 break;
182                 }
183
184                 if (tm >= SPI_TIMEOUT)
185                         debug("*** %s: Time out during SPI transfer\n",
186                               __func__);
187
188                 debug("*** %s: transfer ended. Value=%08x\n", __func__, tmpdin);
189         }
190
191         if (flags & SPI_XFER_END)
192                 spi_cs_deactivate(slave);
193
194         return 0;
195 }