stm class: Add a helper for writing data packets (d279a380) · Commits · 戴 / test

drivers/hwtracing/stm/core.c

+38 −13

Original line number	Original line	Diff line number	Diff line
	@@ -569,27 +569,52 @@ stm_assign_first_policy(struct stm_device stm, struct stm_output output,
	return err;		return err;
	}		}

	static ssize_t notrace stm_write(struct stm_data *data, unsigned int master,		/**
	unsigned int channel, const char *buf, size_t count)		* stm_data_write() - send the given payload as data packets
			* @data: stm driver's data
			* @m: STP master
			* @c: STP channel
			* @ts_first: timestamp the first packet
			* @buf: data payload buffer
			* @count: data payload size
			*/
			ssize_t notrace stm_data_write(struct stm_data *data, unsigned int m,
			unsigned int c, bool ts_first, const void *buf,
			size_t count)
	{		{
	unsigned int flags = STP_PACKET_TIMESTAMPED;		unsigned int flags = ts_first ? STP_PACKET_TIMESTAMPED : 0;
	const unsigned char *p = buf, nil = 0;
	size_t pos;
	ssize_t sz;		ssize_t sz;
			size_t pos;

	for (pos = 0, p = buf; count > pos; pos += sz, p += sz) {		for (pos = 0, sz = 0; pos < count; pos += sz) {
	sz = min_t(unsigned int, count - pos, 8);		sz = min_t(unsigned int, count - pos, 8);
	sz = data->packet(data, master, channel, STP_PACKET_DATA, flags,		sz = data->packet(data, m, c, STP_PACKET_DATA, flags, sz,
	sz, p);		&((u8 *)buf)[pos]);
			if (sz <= 0)
			break;

			if (ts_first) {
	flags = 0;		flags = 0;
			ts_first = false;
			}
			}

	if (sz < 0)		return sz < 0 ? sz : pos;
	break;
	}		}
			EXPORT_SYMBOL_GPL(stm_data_write);

			static ssize_t notrace stm_write(struct stm_data *data, unsigned int master,
			unsigned int channel, const char *buf, size_t count)
			{
			const unsigned char nil = 0;
			ssize_t sz;

	data->packet(data, master, channel, STP_PACKET_FLAG, 0, 0, &nil);		sz = stm_data_write(data, master, channel, true, buf, count);
			if (sz > 0)
			data->packet(data, master, channel, STP_PACKET_FLAG, 0, 0,
			&nil);

	return pos;		return sz;
	}		}

	static ssize_t stm_char_write(struct file file, const char __user buf,		static ssize_t stm_char_write(struct file file, const char __user buf,

drivers/hwtracing/stm/stm.h

+3 −0

Original line number	Original line	Diff line number	Diff line
	@@ -110,5 +110,8 @@ int stm_lookup_protocol(const char *name,
	const struct stm_protocol_driver **pdrv,		const struct stm_protocol_driver **pdrv,
	const struct config_item_type **type);		const struct config_item_type **type);
	void stm_put_protocol(const struct stm_protocol_driver *pdrv);		void stm_put_protocol(const struct stm_protocol_driver *pdrv);
			ssize_t stm_data_write(struct stm_data *data, unsigned int m,
			unsigned int c, bool ts_first, const void *buf,
			size_t count);

	#endif /* _STM_STM_H_ */		#endif /* _STM_STM_H_ */

Admin message