hc
2025-02-14 bbb9540dc49f70f6b703d1c8d1b85fa5f602d86e
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
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
/*
 * SPI slave handler reporting uptime at reception of previous SPI message
 *
 * This SPI slave handler sends the time of reception of the last SPI message
 * as two 32-bit unsigned integers in binary format and in network byte order,
 * representing the number of seconds and fractional seconds (in microseconds)
 * since boot up.
 *
 * Copyright (C) 2016-2017 Glider bvba
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Usage (assuming /dev/spidev2.0 corresponds to the SPI master on the remote
 * system):
 *
 *   # spidev_test -D /dev/spidev2.0 -p dummy-8B
 *   spi mode: 0x0
 *   bits per word: 8
 *   max speed: 500000 Hz (500 KHz)
 *   RX | 00 00 04 6D 00 09 5B BB ...
 *        ^^^^^    ^^^^^^^^
 *        seconds  microseconds
 */
 
#include <linux/completion.h>
#include <linux/module.h>
#include <linux/sched/clock.h>
#include <linux/spi/spi.h>
 
 
struct spi_slave_time_priv {
   struct spi_device *spi;
   struct completion finished;
   struct spi_transfer xfer;
   struct spi_message msg;
   __be32 buf[2];
};
 
static int spi_slave_time_submit(struct spi_slave_time_priv *priv);
 
static void spi_slave_time_complete(void *arg)
{
   struct spi_slave_time_priv *priv = arg;
   int ret;
 
   ret = priv->msg.status;
   if (ret)
       goto terminate;
 
   ret = spi_slave_time_submit(priv);
   if (ret)
       goto terminate;
 
   return;
 
terminate:
   dev_info(&priv->spi->dev, "Terminating\n");
   complete(&priv->finished);
}
 
static int spi_slave_time_submit(struct spi_slave_time_priv *priv)
{
   u32 rem_us;
   int ret;
   u64 ts;
 
   ts = local_clock();
   rem_us = do_div(ts, 1000000000) / 1000;
 
   priv->buf[0] = cpu_to_be32(ts);
   priv->buf[1] = cpu_to_be32(rem_us);
 
   spi_message_init_with_transfers(&priv->msg, &priv->xfer, 1);
 
   priv->msg.complete = spi_slave_time_complete;
   priv->msg.context = priv;
 
   ret = spi_async(priv->spi, &priv->msg);
   if (ret)
       dev_err(&priv->spi->dev, "spi_async() failed %d\n", ret);
 
   return ret;
}
 
static int spi_slave_time_probe(struct spi_device *spi)
{
   struct spi_slave_time_priv *priv;
   int ret;
 
   priv = devm_kzalloc(&spi->dev, sizeof(*priv), GFP_KERNEL);
   if (!priv)
       return -ENOMEM;
 
   priv->spi = spi;
   init_completion(&priv->finished);
   priv->xfer.tx_buf = priv->buf;
   priv->xfer.len = sizeof(priv->buf);
 
   ret = spi_slave_time_submit(priv);
   if (ret)
       return ret;
 
   spi_set_drvdata(spi, priv);
   return 0;
}
 
static int spi_slave_time_remove(struct spi_device *spi)
{
   struct spi_slave_time_priv *priv = spi_get_drvdata(spi);
 
   spi_slave_abort(spi);
   wait_for_completion(&priv->finished);
   return 0;
}
 
static struct spi_driver spi_slave_time_driver = {
   .driver = {
       .name    = "spi-slave-time",
   },
   .probe        = spi_slave_time_probe,
   .remove        = spi_slave_time_remove,
};
module_spi_driver(spi_slave_time_driver);
 
MODULE_AUTHOR("Geert Uytterhoeven <geert+renesas@glider.be>");
MODULE_DESCRIPTION("SPI slave reporting uptime at previous SPI message");
MODULE_LICENSE("GPL v2");