native_system_service.c

// SPDX-License-Identifier: BSD-3-Clause
/*
 * Copyright(c) 2020 Intel Corporation. All rights reserved.
 *
 * Author: Jaroslaw Stelter <jaroslaw.stelter@linux.intel.com>
 *	   Adrian Warecki <adrian.warecki@intel.com>
 */
/*
 * Native System Service interface for ADSP loadable library.
 */

#include <errno.h>
#include <stdbool.h>
#include <sof/common.h>
#include <rtos/sof.h>
#include <rtos/string.h>
#include <ipc4/notification.h>
#include <sof/ipc/msg.h>
#include <native_system_service.h>
#include <sof/lib_manager.h>
#include <module/module/logger.h>
#include <rtos/userspace_helper.h>

#define RSIZE_MAX 0x7FFFFFFF

 /*! Module log level priority to sof log level conversion array */
const int log_priority_map[L_MAX] = {
	/*! Critical message. */
	[L_CRITICAL] = LOG_LEVEL_CRITICAL,
	/*! Error message. */
	[L_ERROR] = LOG_LEVEL_ERROR,
	/*! High importance log level. */
	[L_HIGH] = LOG_LEVEL_ERROR,
	/*! Warning message. */
	[L_WARNING] = LOG_LEVEL_WARNING,
	/*! Medium importance log level. */
	[L_MEDIUM] = LOG_LEVEL_WARNING,
	/*! Low importance log level. */
	[L_LOW] = LOG_LEVEL_INFO,
	/*! Information. */
	[L_INFO] = LOG_LEVEL_INFO,
	/*! Verbose message. */
	[L_VERBOSE] = LOG_LEVEL_VERBOSE,
	[L_DEBUG] = LOG_LEVEL_DEBUG
};

static int log_priority_to_sof_level(enum log_priority log_priority)
{
	if ((uint32_t)log_priority >= L_DEBUG)
		return LOG_LEVEL_DEBUG;

	return log_priority_map[log_priority];
}

void native_system_service_log_message(enum log_priority log_priority, uint32_t log_entry,
				       struct log_handle const *log_handle, uint32_t param1,
				       uint32_t param2, uint32_t param3, uint32_t param4)
{
	log_priority_to_sof_level(log_priority);
	uint32_t argc = (log_entry & 0x7);
	/* TODO: Need to call here function like _log_sofdict, since we do not have format */
	/*       passed from library */
	/* This function could be finished when cAVS/ACE logging formats support will be */
	/* added to SOF.*/
	switch (argc) {
	case 1:
	break;

	case 2:
	break;

	case 3:
	break;

	case 4:
	break;

	default:
	break;
	}
}

AdspErrorCode native_system_service_safe_memcpy(void *RESTRICT dst, size_t maxlen,
						const void *RESTRICT src,
						size_t len)
{
	return (AdspErrorCode) memcpy_s(dst, maxlen, src, len);
}

AdspErrorCode native_system_service_safe_memmove(void *dst, size_t maxlen, const void *src,
						 size_t len)
{
	if (dst == NULL || maxlen > RSIZE_MAX)
		return ADSP_INVALID_PARAMETERS;

	if (src == NULL || len > maxlen) {
		memset(dst, 0, maxlen);
		return ADSP_INVALID_PARAMETERS;
	}

	if (len != 0) {
		/* TODO: now it is memcopy. Finally it will be remap maybe?
		 * Fix it when memory management API will be available.
		 * memmove(dst, src, len);
		 */
		memcpy_s(dst, maxlen, src, len);
	}
	return ADSP_NO_ERROR;
}

void *native_system_service_vec_memset(void *dst, int c, size_t len)
{
	/* TODO: Currently simple memset. Should be changed. */
	memset(dst, c, len);
	return dst;
}

AdspErrorCode native_system_service_create_notification(struct notification_params *params,
							uint8_t *notification_buffer,
							uint32_t notification_buffer_size,
							struct notification_handle **handle)
{
	if ((params == NULL) || (notification_buffer == NULL)
		|| (notification_buffer_size <= 0) || (handle == NULL))
		return ADSP_INVALID_PARAMETERS;

	union ipc4_notification_header header;

	header.r.notif_type = params->type;
	header.r._reserved_0 = params->user_val_1;
	header.r.type = SOF_IPC4_GLB_NOTIFICATION;
	header.r.rsp = SOF_IPC4_MESSAGE_DIR_MSG_REQUEST;
	header.r.msg_tgt = SOF_IPC4_MESSAGE_TARGET_FW_GEN_MSG;
	struct ipc_msg *msg = lib_notif_msg_init((uint32_t)header.dat, notification_buffer_size);

	if (msg) {
		*handle = (struct notification_handle *)msg;
		params->payload = msg->tx_data;
	}

	return ADSP_NO_ERROR;
}


AdspErrorCode native_system_service_send_notif_msg(enum notification_target notification_target,
						   struct notification_handle *message,
						   uint32_t actual_payload_size)
{
	if ((message == NULL) || (actual_payload_size == 0))
		return ADSP_INVALID_PARAMETERS;

	struct ipc_msg *msg = (struct ipc_msg *)message;

	lib_notif_msg_send(msg);
	return ADSP_NO_ERROR;
}

AdspErrorCode native_system_service_get_interface(enum interface_id id,
						  struct system_service_iface **iface)
{
	if (id < 0)
		return ADSP_INVALID_PARAMETERS;
	return ADSP_NO_ERROR;
}

const APP_TASK_DATA struct native_system_service native_system_service = {
	.basic = {
		.log_message = native_system_service_log_message,
		.safe_memcpy = native_system_service_safe_memcpy,
		.safe_memmove = native_system_service_safe_memmove,
		.vec_memset = native_system_service_vec_memset,
		.notification_create = native_system_service_create_notification,
		.notification_send = native_system_service_send_notif_msg,
		.get_interface = native_system_service_get_interface
	}
};