ax88796c-spi-linux-driver/ax88796c_spi.c at main · ASIXElectronics/ax88796c-spi-linux-driver · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
#include "ax88796c_spi.h"

/* driver bus management functions */
void axspi_wakeup (struct axspi_data *ax_spi)
{
	u8 tx_buf;
	int ret;

	tx_buf = AX_SPICMD_EXIT_PWD;	// OP
	ret = spi_write(ax_spi->spi, &tx_buf, 1);
	if (ret)
		printk (": %s() failed: ret = %d\n", __func__, ret);
}

void axspi_read_status (struct axspi_data *ax_spi, struct spi_status *status)
{
	u8 tx_buf;
	int ret;

	/* OP */
	tx_buf = AX_SPICMD_READ_STATUS;
	ret = spi_write_then_read (ax_spi->spi, &tx_buf, 1, (u8 *)&status, 3);
	if (ret)
		printk (": %s() failed: ret = %d\n", __func__, ret);
	else
		le16_to_cpus (&status->isr);
}

int axspi_read_rxq (struct axspi_data *ax_spi, void *data, int len)
{
	struct spi_transfer *xfer = ax_spi->spi_rx_xfer;
	int ret;

	memcpy (ax_spi->cmd_buf, rx_cmd_buf, 5);

	xfer->tx_buf = ax_spi->cmd_buf;
	xfer->rx_buf = NULL;
	xfer->len = ax_spi->comp ? 2 : 5;
	xfer->bits_per_word = 8;
	spi_message_add_tail(xfer, &ax_spi->rx_msg);

	xfer++;
	xfer->rx_buf = data;
	xfer->tx_buf = NULL;
	xfer->len = len;
	xfer->bits_per_word = 8;
	spi_message_add_tail(xfer, &ax_spi->rx_msg);

	ret = spi_sync(ax_spi->spi, &ax_spi->rx_msg);
	if (ret)
		printk (": %s() failed: ret = %d\n", __func__, ret);

	return ret;
}

int axspi_write_txq (struct axspi_data *ax_spi, void *data, int len)
{
	return spi_write(ax_spi->spi, data, len);
}

u16 axspi_read_reg (struct axspi_data *ax_spi, u8 reg)
{
	u8 tx_buf[4];
	u16 rx_buf = 0;
	int ret;
	int len = ax_spi->comp ? 3 : 4;

	tx_buf[0] = 0x03;	// OP code read register
	tx_buf[1] = reg;	// register address
	tx_buf[2] = 0xFF;	// dumy cycle
	tx_buf[3] = 0xFF;	// dumy cycle
	ret = spi_write_then_read (ax_spi->spi, tx_buf, len, (u8 *)&rx_buf, 2);
	if (ret)
		printk (": %s() failed: ret = %d\n", __func__, ret);
	else
		le16_to_cpus (&rx_buf);

	return rx_buf;
}

void axspi_write_reg (struct axspi_data *ax_spi, u8 reg, u16 value)
{
	u8 tx_buf[4];
	int ret;

	tx_buf[0] = AX_SPICMD_WRITE_REG;	// OP code read register
	tx_buf[1] = reg;			// register address
	tx_buf[2] = value;
	tx_buf[3] = value >> 8;

	ret = spi_write(ax_spi->spi, tx_buf, 4);
	if (ret)
		printk (": %s() failed: ret = %d\n", __func__, ret);

}