xref: /OK3568_Linux_fs/kernel/samples/rpmsg/rpmsg_client_sample.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Remote processor messaging - sample client driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2011 Texas Instruments, Inc.
6*4882a593Smuzhiyun  * Copyright (C) 2011 Google, Inc.
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * Ohad Ben-Cohen <ohad@wizery.com>
9*4882a593Smuzhiyun  * Brian Swetland <swetland@google.com>
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/kernel.h>
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/rpmsg.h>
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun #define MSG		"hello world!"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun static int count = 100;
19*4882a593Smuzhiyun module_param(count, int, 0644);
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun struct instance_data {
22*4882a593Smuzhiyun 	int rx_count;
23*4882a593Smuzhiyun };
24*4882a593Smuzhiyun 
rpmsg_sample_cb(struct rpmsg_device * rpdev,void * data,int len,void * priv,u32 src)25*4882a593Smuzhiyun static int rpmsg_sample_cb(struct rpmsg_device *rpdev, void *data, int len,
26*4882a593Smuzhiyun 						void *priv, u32 src)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun 	int ret;
29*4882a593Smuzhiyun 	struct instance_data *idata = dev_get_drvdata(&rpdev->dev);
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun 	dev_info(&rpdev->dev, "incoming msg %d (src: 0x%x)\n",
32*4882a593Smuzhiyun 		 ++idata->rx_count, src);
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun 	print_hex_dump_debug(__func__, DUMP_PREFIX_NONE, 16, 1, data, len,
35*4882a593Smuzhiyun 			     true);
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 	/* samples should not live forever */
38*4882a593Smuzhiyun 	if (idata->rx_count >= count) {
39*4882a593Smuzhiyun 		dev_info(&rpdev->dev, "goodbye!\n");
40*4882a593Smuzhiyun 		return 0;
41*4882a593Smuzhiyun 	}
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun 	/* send a new message now */
44*4882a593Smuzhiyun 	ret = rpmsg_send(rpdev->ept, MSG, strlen(MSG));
45*4882a593Smuzhiyun 	if (ret)
46*4882a593Smuzhiyun 		dev_err(&rpdev->dev, "rpmsg_send failed: %d\n", ret);
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	return 0;
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun 
rpmsg_sample_probe(struct rpmsg_device * rpdev)51*4882a593Smuzhiyun static int rpmsg_sample_probe(struct rpmsg_device *rpdev)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun 	int ret;
54*4882a593Smuzhiyun 	struct instance_data *idata;
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun 	dev_info(&rpdev->dev, "new channel: 0x%x -> 0x%x!\n",
57*4882a593Smuzhiyun 					rpdev->src, rpdev->dst);
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 	idata = devm_kzalloc(&rpdev->dev, sizeof(*idata), GFP_KERNEL);
60*4882a593Smuzhiyun 	if (!idata)
61*4882a593Smuzhiyun 		return -ENOMEM;
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	dev_set_drvdata(&rpdev->dev, idata);
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 	/* send a message to our remote processor */
66*4882a593Smuzhiyun 	ret = rpmsg_send(rpdev->ept, MSG, strlen(MSG));
67*4882a593Smuzhiyun 	if (ret) {
68*4882a593Smuzhiyun 		dev_err(&rpdev->dev, "rpmsg_send failed: %d\n", ret);
69*4882a593Smuzhiyun 		return ret;
70*4882a593Smuzhiyun 	}
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 	return 0;
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun 
rpmsg_sample_remove(struct rpmsg_device * rpdev)75*4882a593Smuzhiyun static void rpmsg_sample_remove(struct rpmsg_device *rpdev)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun 	dev_info(&rpdev->dev, "rpmsg sample client driver is removed\n");
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun static struct rpmsg_device_id rpmsg_driver_sample_id_table[] = {
81*4882a593Smuzhiyun 	{ .name	= "rpmsg-client-sample" },
82*4882a593Smuzhiyun 	{ },
83*4882a593Smuzhiyun };
84*4882a593Smuzhiyun MODULE_DEVICE_TABLE(rpmsg, rpmsg_driver_sample_id_table);
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun static struct rpmsg_driver rpmsg_sample_client = {
87*4882a593Smuzhiyun 	.drv.name	= KBUILD_MODNAME,
88*4882a593Smuzhiyun 	.id_table	= rpmsg_driver_sample_id_table,
89*4882a593Smuzhiyun 	.probe		= rpmsg_sample_probe,
90*4882a593Smuzhiyun 	.callback	= rpmsg_sample_cb,
91*4882a593Smuzhiyun 	.remove		= rpmsg_sample_remove,
92*4882a593Smuzhiyun };
93*4882a593Smuzhiyun module_rpmsg_driver(rpmsg_sample_client);
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun MODULE_DESCRIPTION("Remote processor messaging sample client driver");
96*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
97