18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2007 Red Hat, Inc.  All rights reserved.
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <net/genetlink.h>
78c2ecf20Sopenharmony_ci#include <linux/dlm.h>
88c2ecf20Sopenharmony_ci#include <linux/dlm_netlink.h>
98c2ecf20Sopenharmony_ci#include <linux/gfp.h>
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ci#include "dlm_internal.h"
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_cistatic uint32_t dlm_nl_seqnum;
148c2ecf20Sopenharmony_cistatic uint32_t listener_nlportid;
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_cistatic struct genl_family family;
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_cistatic int prepare_data(u8 cmd, struct sk_buff **skbp, size_t size)
198c2ecf20Sopenharmony_ci{
208c2ecf20Sopenharmony_ci	struct sk_buff *skb;
218c2ecf20Sopenharmony_ci	void *data;
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_ci	skb = genlmsg_new(size, GFP_NOFS);
248c2ecf20Sopenharmony_ci	if (!skb)
258c2ecf20Sopenharmony_ci		return -ENOMEM;
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci	/* add the message headers */
288c2ecf20Sopenharmony_ci	data = genlmsg_put(skb, 0, dlm_nl_seqnum++, &family, 0, cmd);
298c2ecf20Sopenharmony_ci	if (!data) {
308c2ecf20Sopenharmony_ci		nlmsg_free(skb);
318c2ecf20Sopenharmony_ci		return -EINVAL;
328c2ecf20Sopenharmony_ci	}
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci	*skbp = skb;
358c2ecf20Sopenharmony_ci	return 0;
368c2ecf20Sopenharmony_ci}
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_cistatic struct dlm_lock_data *mk_data(struct sk_buff *skb)
398c2ecf20Sopenharmony_ci{
408c2ecf20Sopenharmony_ci	struct nlattr *ret;
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	ret = nla_reserve(skb, DLM_TYPE_LOCK, sizeof(struct dlm_lock_data));
438c2ecf20Sopenharmony_ci	if (!ret)
448c2ecf20Sopenharmony_ci		return NULL;
458c2ecf20Sopenharmony_ci	return nla_data(ret);
468c2ecf20Sopenharmony_ci}
478c2ecf20Sopenharmony_ci
488c2ecf20Sopenharmony_cistatic int send_data(struct sk_buff *skb)
498c2ecf20Sopenharmony_ci{
508c2ecf20Sopenharmony_ci	struct genlmsghdr *genlhdr = nlmsg_data((struct nlmsghdr *)skb->data);
518c2ecf20Sopenharmony_ci	void *data = genlmsg_data(genlhdr);
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci	genlmsg_end(skb, data);
548c2ecf20Sopenharmony_ci
558c2ecf20Sopenharmony_ci	return genlmsg_unicast(&init_net, skb, listener_nlportid);
568c2ecf20Sopenharmony_ci}
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_cistatic int user_cmd(struct sk_buff *skb, struct genl_info *info)
598c2ecf20Sopenharmony_ci{
608c2ecf20Sopenharmony_ci	listener_nlportid = info->snd_portid;
618c2ecf20Sopenharmony_ci	printk("user_cmd nlpid %u\n", listener_nlportid);
628c2ecf20Sopenharmony_ci	return 0;
638c2ecf20Sopenharmony_ci}
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_cistatic const struct genl_small_ops dlm_nl_ops[] = {
668c2ecf20Sopenharmony_ci	{
678c2ecf20Sopenharmony_ci		.cmd	= DLM_CMD_HELLO,
688c2ecf20Sopenharmony_ci		.validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
698c2ecf20Sopenharmony_ci		.doit	= user_cmd,
708c2ecf20Sopenharmony_ci	},
718c2ecf20Sopenharmony_ci};
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_cistatic struct genl_family family __ro_after_init = {
748c2ecf20Sopenharmony_ci	.name		= DLM_GENL_NAME,
758c2ecf20Sopenharmony_ci	.version	= DLM_GENL_VERSION,
768c2ecf20Sopenharmony_ci	.small_ops	= dlm_nl_ops,
778c2ecf20Sopenharmony_ci	.n_small_ops	= ARRAY_SIZE(dlm_nl_ops),
788c2ecf20Sopenharmony_ci	.module		= THIS_MODULE,
798c2ecf20Sopenharmony_ci};
808c2ecf20Sopenharmony_ci
818c2ecf20Sopenharmony_ciint __init dlm_netlink_init(void)
828c2ecf20Sopenharmony_ci{
838c2ecf20Sopenharmony_ci	return genl_register_family(&family);
848c2ecf20Sopenharmony_ci}
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_civoid dlm_netlink_exit(void)
878c2ecf20Sopenharmony_ci{
888c2ecf20Sopenharmony_ci	genl_unregister_family(&family);
898c2ecf20Sopenharmony_ci}
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_cistatic void fill_data(struct dlm_lock_data *data, struct dlm_lkb *lkb)
928c2ecf20Sopenharmony_ci{
938c2ecf20Sopenharmony_ci	struct dlm_rsb *r = lkb->lkb_resource;
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	memset(data, 0, sizeof(struct dlm_lock_data));
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	data->version = DLM_LOCK_DATA_VERSION;
988c2ecf20Sopenharmony_ci	data->nodeid = lkb->lkb_nodeid;
998c2ecf20Sopenharmony_ci	data->ownpid = lkb->lkb_ownpid;
1008c2ecf20Sopenharmony_ci	data->id = lkb->lkb_id;
1018c2ecf20Sopenharmony_ci	data->remid = lkb->lkb_remid;
1028c2ecf20Sopenharmony_ci	data->status = lkb->lkb_status;
1038c2ecf20Sopenharmony_ci	data->grmode = lkb->lkb_grmode;
1048c2ecf20Sopenharmony_ci	data->rqmode = lkb->lkb_rqmode;
1058c2ecf20Sopenharmony_ci	if (lkb->lkb_ua)
1068c2ecf20Sopenharmony_ci		data->xid = lkb->lkb_ua->xid;
1078c2ecf20Sopenharmony_ci	if (r) {
1088c2ecf20Sopenharmony_ci		data->lockspace_id = r->res_ls->ls_global_id;
1098c2ecf20Sopenharmony_ci		data->resource_namelen = r->res_length;
1108c2ecf20Sopenharmony_ci		memcpy(data->resource_name, r->res_name, r->res_length);
1118c2ecf20Sopenharmony_ci	}
1128c2ecf20Sopenharmony_ci}
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_civoid dlm_timeout_warn(struct dlm_lkb *lkb)
1158c2ecf20Sopenharmony_ci{
1168c2ecf20Sopenharmony_ci	struct sk_buff *send_skb;
1178c2ecf20Sopenharmony_ci	struct dlm_lock_data *data;
1188c2ecf20Sopenharmony_ci	size_t size;
1198c2ecf20Sopenharmony_ci	int rv;
1208c2ecf20Sopenharmony_ci
1218c2ecf20Sopenharmony_ci	size = nla_total_size(sizeof(struct dlm_lock_data)) +
1228c2ecf20Sopenharmony_ci	       nla_total_size(0); /* why this? */
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci	rv = prepare_data(DLM_CMD_TIMEOUT, &send_skb, size);
1258c2ecf20Sopenharmony_ci	if (rv < 0)
1268c2ecf20Sopenharmony_ci		return;
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ci	data = mk_data(send_skb);
1298c2ecf20Sopenharmony_ci	if (!data) {
1308c2ecf20Sopenharmony_ci		nlmsg_free(send_skb);
1318c2ecf20Sopenharmony_ci		return;
1328c2ecf20Sopenharmony_ci	}
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci	fill_data(data, lkb);
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	send_data(send_skb);
1378c2ecf20Sopenharmony_ci}
1388c2ecf20Sopenharmony_ci
139