Commit 7139bde3 authored by Yizhen Fan's avatar Yizhen Fan Committed by fanyizhen1995
Browse files

ub: ubcore add cmd config and show utp implementation. 



driver inclusion
category: feature
bugzilla: NA
CVE: NA

--------------------------------

Ubcore add implementations of handling config and show utp cmd from
user layer.

Signed-off-by: default avatarGuoxin Qian <qianguoxin@huawei.com>
Signed-off-by: default avatarYizhen Fan <fanyizhen@huawei.com>
parent 1763ad77

drivers/ub/urma/ubcore/ubcore_cmd.h

+19 −0
Original line number Diff line number Diff line
@@ -95,6 +95,25 @@ struct ubcore_cmd_query_res { 
	} out;

};



struct ubcore_cmd_set_utp {

	struct {

		char dev_name[UBCORE_MAX_DEV_NAME];

		uint8_t eid[UBCORE_CMD_EID_SIZE];

		uint32_t transport_type;

		bool spray_en;

		uint16_t data_udp_start;

		uint8_t udp_range;

	} in;

};



struct ubcore_cmd_show_utp {

	struct {

		char dev_name[UBCORE_MAX_DEV_NAME];

		uint8_t eid[UBCORE_CMD_EID_SIZE];

		uint32_t transport_type;

	} in;

};



/* copy from user_space addr to kernel args */

static inline int ubcore_copy_from_user(void *args, const void *args_addr, unsigned long args_size)

{

drivers/ub/urma/ubcore/ubcore_device.c

+5 −0
Original line number Diff line number Diff line
@@ -520,6 +520,11 @@ void ubcore_dispatch_async_event(struct ubcore_event *event) 
		return;

	}



	if (event->event_type == UBCORE_EVENT_TP_ERR && event->element.tp != NULL) {

		ubcore_restore_tp(event->ub_dev, event->element.tp);

		return;

	}



	dev = event->ub_dev;

	spin_lock_irqsave(&dev->event_handler_lock, flags);

	list_for_each_entry(handler, &dev->event_handler_list, node)

drivers/ub/urma/ubcore/ubcore_main.c

+80 −0
Original line number Diff line number Diff line
@@ -153,6 +153,82 @@ static int ubcore_cmd_put_uasid(struct ubcore_cmd_hdr *hdr) 
	return 0;

}



static void ubcore_set_utp_cfg(struct ubcore_cmd_set_utp *arg, struct ubcore_utp_attr *attr,

			       union ubcore_utp_attr_mask *mask)

{

	attr->flag.bs.spray_en = arg->in.spray_en;

	attr->data_udp_start = arg->in.data_udp_start;

	attr->udp_range = arg->in.udp_range;

	mask->bs.flag = 1;

	mask->bs.udp_port = 1;

	mask->bs.udp_range = 1;

}



static int ubcore_cmd_set_utp(struct ubcore_cmd_hdr *hdr)

{

	enum ubcore_transport_type trans_type;

	union ubcore_utp_attr_mask mask = { 0 };

	struct ubcore_cmd_set_utp arg;

	struct ubcore_utp_attr attr;

	struct ubcore_device *dev;

	union ubcore_eid eid;

	int ret;



	ret = ubcore_copy_from_user(&arg, (void __user *)(uintptr_t)hdr->args_addr,

				    sizeof(struct ubcore_cmd_set_utp));

	if (ret != 0)

		return -EPERM;



	(void)memcpy(eid.raw, arg.in.eid, UBCORE_EID_SIZE);

	trans_type = arg.in.transport_type;

	dev = ubcore_find_device(&eid, trans_type);

	if (dev == NULL || ubcore_check_dev_name_invalid(dev, arg.in.dev_name)) {

		ubcore_log_err("find dev failed, dev:%s, arg_in: %s.\n",

			       dev == NULL ? "NULL" : dev->dev_name, arg.in.dev_name);

		return -EINVAL;

	}



	ubcore_set_utp_cfg(&arg, &attr, &mask);

	if (ubcore_config_utp(dev, &eid, &attr, mask) != 0) {

		ubcore_log_err("config utp failed.\n");

		ubcore_put_device(dev);

		return -EPERM;

	}

	ubcore_put_device(dev);

	return 0;

}



static int ubcore_cmd_show_utp(struct ubcore_cmd_hdr *hdr)

{

	enum ubcore_transport_type trans_type;

	struct ubcore_cmd_show_utp arg;

	struct ubcore_device *dev;

	union ubcore_eid eid;

	int ret;



	ret = ubcore_copy_from_user(&arg, (void __user *)(uintptr_t)hdr->args_addr,

				    sizeof(struct ubcore_cmd_show_utp));

	if (ret != 0)

		return -EPERM;



	(void)memcpy(eid.raw, arg.in.eid, UBCORE_EID_SIZE);

	trans_type = arg.in.transport_type;



	dev = ubcore_find_device(&eid, trans_type);

	if (dev == NULL || ubcore_check_dev_name_invalid(dev, arg.in.dev_name)) {

		ubcore_log_err("find dev failed, dev:%s, arg_in: %s.\n",

			       dev == NULL ? "NULL" : dev->dev_name, arg.in.dev_name);

		return -EINVAL;

	}

	if (ubcore_show_utp(dev, &eid) != 0) {

		ubcore_log_err("show utp failed.\n");

		ubcore_put_device(dev);

		return -EPERM;

	}

	ubcore_put_device(dev);

	return 0;

}



static int ubcore_cmd_query_stats(struct ubcore_cmd_hdr *hdr)

{

	enum ubcore_transport_type trans_type;
@@ -428,6 +504,10 @@ static int ubcore_cmd_parse(struct ubcore_cmd_hdr *hdr) 
		return ubcore_cmd_set_uasid(hdr);

	case UBCORE_CMD_PUT_UASID:

		return ubcore_cmd_put_uasid(hdr);

	case UBCORE_CMD_SET_UTP:

		return ubcore_cmd_set_utp(hdr);

	case UBCORE_CMD_SHOW_UTP:

		return ubcore_cmd_show_utp(hdr);

	case UBCORE_CMD_QUERY_STATS:

		return ubcore_cmd_query_stats(hdr);

	case UBCORE_CMD_QUERY_RES: