1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11
12#include "greybus.h"
13#include "gbphy.h"
14#include "spilib.h"
15
16static struct spilib_ops *spilib_ops;
17
18static int gb_spi_probe(struct gbphy_device *gbphy_dev,
19 const struct gbphy_device_id *id)
20{
21 struct gb_connection *connection;
22 int ret;
23
24 connection = gb_connection_create(gbphy_dev->bundle,
25 le16_to_cpu(gbphy_dev->cport_desc->id),
26 NULL);
27 if (IS_ERR(connection))
28 return PTR_ERR(connection);
29
30 ret = gb_connection_enable(connection);
31 if (ret)
32 goto exit_connection_destroy;
33
34 ret = gb_spilib_master_init(connection, &gbphy_dev->dev, spilib_ops);
35 if (ret)
36 goto exit_connection_disable;
37
38 gb_gbphy_set_data(gbphy_dev, connection);
39
40 gbphy_runtime_put_autosuspend(gbphy_dev);
41 return 0;
42
43exit_connection_disable:
44 gb_connection_disable(connection);
45exit_connection_destroy:
46 gb_connection_destroy(connection);
47
48 return ret;
49}
50
51static void gb_spi_remove(struct gbphy_device *gbphy_dev)
52{
53 struct gb_connection *connection = gb_gbphy_get_data(gbphy_dev);
54 int ret;
55
56 ret = gbphy_runtime_get_sync(gbphy_dev);
57 if (ret)
58 gbphy_runtime_get_noresume(gbphy_dev);
59
60 gb_spilib_master_exit(connection);
61 gb_connection_disable(connection);
62 gb_connection_destroy(connection);
63}
64
65static const struct gbphy_device_id gb_spi_id_table[] = {
66 { GBPHY_PROTOCOL(GREYBUS_PROTOCOL_SPI) },
67 { },
68};
69MODULE_DEVICE_TABLE(gbphy, gb_spi_id_table);
70
71static struct gbphy_driver spi_driver = {
72 .name = "spi",
73 .probe = gb_spi_probe,
74 .remove = gb_spi_remove,
75 .id_table = gb_spi_id_table,
76};
77
78module_gbphy_driver(spi_driver);
79MODULE_LICENSE("GPL v2");
80