1// SPDX-License-Identifier: GPL-2.0
 2/*
 3 * Basic framing protocol for STM devices.
 4 * Copyright (c) 2018, Intel Corporation.
 5 */
 6
 7#include <linux/module.h>
 8#include <linux/device.h>
 9#include <linux/stm.h>
10#include "stm.h"
11
12static ssize_t basic_write(struct stm_data *data, struct stm_output *output,
13			   unsigned int chan, const char *buf, size_t count,
14			   struct stm_source_data *source)
15{
16	unsigned int c = output->channel + chan;
17	unsigned int m = output->master;
18	const unsigned char nil = 0;
19	ssize_t sz;
20
21	sz = stm_data_write(data, m, c, true, buf, count);
22	if (sz > 0)
23		data->packet(data, m, c, STP_PACKET_FLAG, 0, 0, &nil);
24
25	return sz;
26}
27
28static const struct stm_protocol_driver basic_pdrv = {
29	.owner	= THIS_MODULE,
30	.name	= "p_basic",
31	.write	= basic_write,
32};
33
34static int basic_stm_init(void)
35{
36	return stm_register_protocol(&basic_pdrv);
37}
38
39static void basic_stm_exit(void)
40{
41	stm_unregister_protocol(&basic_pdrv);
42}
43
44module_init(basic_stm_init);
45module_exit(basic_stm_exit);
46
47MODULE_LICENSE("GPL v2");
48MODULE_DESCRIPTION("Basic STM framing protocol driver");
49MODULE_AUTHOR("Alexander Shishkin <alexander.shishkin@linux.intel.com>");