xref: /openbmc/u-boot/drivers/spi/spi-mem-nodm.c (revision 7e2ae620)
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2018 Texas Instruments Incorporated - http://www.ti.com/
4  */
5 
6 #include <spi.h>
7 #include <spi-mem.h>
8 
9 int spi_mem_exec_op(struct spi_slave *slave,
10 		    const struct spi_mem_op *op)
11 {
12 	unsigned int pos = 0;
13 	const u8 *tx_buf = NULL;
14 	u8 *rx_buf = NULL;
15 	u8 *op_buf;
16 	int op_len;
17 	u32 flag;
18 	int ret;
19 	int i;
20 
21 	if (op->data.nbytes) {
22 		if (op->data.dir == SPI_MEM_DATA_IN)
23 			rx_buf = op->data.buf.in;
24 		else
25 			tx_buf = op->data.buf.out;
26 	}
27 
28 	op_len = sizeof(op->cmd.opcode) + op->addr.nbytes + op->dummy.nbytes;
29 	op_buf = calloc(1, op_len);
30 
31 	ret = spi_claim_bus(slave);
32 	if (ret < 0)
33 		return ret;
34 
35 	op_buf[pos++] = op->cmd.opcode;
36 
37 	if (op->addr.nbytes) {
38 		for (i = 0; i < op->addr.nbytes; i++)
39 			op_buf[pos + i] = op->addr.val >>
40 				(8 * (op->addr.nbytes - i - 1));
41 
42 		pos += op->addr.nbytes;
43 	}
44 
45 	if (op->dummy.nbytes)
46 		memset(op_buf + pos, 0xff, op->dummy.nbytes);
47 
48 	/* 1st transfer: opcode + address + dummy cycles */
49 	flag = SPI_XFER_BEGIN;
50 	/* Make sure to set END bit if no tx or rx data messages follow */
51 	if (!tx_buf && !rx_buf)
52 		flag |= SPI_XFER_END;
53 
54 	ret = spi_xfer(slave, op_len * 8, op_buf, NULL, flag);
55 	if (ret)
56 		return ret;
57 
58 	/* 2nd transfer: rx or tx data path */
59 	if (tx_buf || rx_buf) {
60 		ret = spi_xfer(slave, op->data.nbytes * 8, tx_buf,
61 			       rx_buf, SPI_XFER_END);
62 		if (ret)
63 			return ret;
64 	}
65 
66 	spi_release_bus(slave);
67 
68 	for (i = 0; i < pos; i++)
69 		debug("%02x ", op_buf[i]);
70 	debug("| [%dB %s] ",
71 	      tx_buf || rx_buf ? op->data.nbytes : 0,
72 	      tx_buf || rx_buf ? (tx_buf ? "out" : "in") : "-");
73 	for (i = 0; i < op->data.nbytes; i++)
74 		debug("%02x ", tx_buf ? tx_buf[i] : rx_buf[i]);
75 	debug("[ret %d]\n", ret);
76 
77 	free(op_buf);
78 
79 	if (ret < 0)
80 		return ret;
81 
82 	return 0;
83 }
84 
85 int spi_mem_adjust_op_size(struct spi_slave *slave,
86 			   struct spi_mem_op *op)
87 {
88 	unsigned int len;
89 
90 	len = sizeof(op->cmd.opcode) + op->addr.nbytes + op->dummy.nbytes;
91 	if (slave->max_write_size && len > slave->max_write_size)
92 		return -EINVAL;
93 
94 	if (op->data.dir == SPI_MEM_DATA_IN && slave->max_read_size)
95 		op->data.nbytes = min(op->data.nbytes,
96 				      slave->max_read_size);
97 	else if (slave->max_write_size)
98 		op->data.nbytes = min(op->data.nbytes,
99 				      slave->max_write_size - len);
100 
101 	if (!op->data.nbytes)
102 		return -EINVAL;
103 
104 	return 0;
105 }
106