130 lines
3.3 KiB
C
130 lines
3.3 KiB
C
/* ipm_console.c - Console messages to/from another processor */
|
|
|
|
/*
|
|
* Copyright (c) 2015 Intel Corporation
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include <errno.h>
|
|
|
|
#include <nanokernel.h>
|
|
#include <misc/ring_buffer.h>
|
|
#include <misc/printk.h>
|
|
#include <stdio.h>
|
|
#include <ipm.h>
|
|
#include <console/ipm_console.h>
|
|
|
|
static void ipm_console_fiber(int arg1, int arg2)
|
|
{
|
|
uint8_t size32;
|
|
uint16_t type;
|
|
int ret;
|
|
struct device *d;
|
|
struct ipm_console_receiver_config_info *config_info;
|
|
struct ipm_console_receiver_runtime_data *driver_data;
|
|
int pos;
|
|
|
|
d = (struct device *)arg1;
|
|
driver_data = d->driver_data;
|
|
config_info = d->config->config_info;
|
|
ARG_UNUSED(arg2);
|
|
size32 = 0;
|
|
pos = 0;
|
|
|
|
while (1) {
|
|
nano_fiber_sem_take(&driver_data->sem, TICKS_UNLIMITED);
|
|
|
|
ret = sys_ring_buf_get(&driver_data->rb, &type,
|
|
(uint8_t *)&config_info->line_buf[pos],
|
|
NULL, &size32);
|
|
if (ret) {
|
|
/* Shouldn't ever happen... */
|
|
printk("ipm console ring buffer error: %d\n", ret);
|
|
size32 = 0;
|
|
continue;
|
|
}
|
|
|
|
if (config_info->line_buf[pos] == '\n' ||
|
|
pos == config_info->lb_size - 2) {
|
|
if (pos != config_info->lb_size - 2) {
|
|
config_info->line_buf[pos] = '\0';
|
|
} else {
|
|
config_info->line_buf[pos + 1] = '\0';
|
|
}
|
|
if (config_info->flags & IPM_CONSOLE_PRINTK) {
|
|
printk("%s: '%s'\n", d->config->name,
|
|
config_info->line_buf);
|
|
}
|
|
if (config_info->flags & IPM_CONSOLE_STDOUT) {
|
|
printf("%s: '%s'\n", d->config->name,
|
|
config_info->line_buf);
|
|
}
|
|
pos = 0;
|
|
} else {
|
|
++pos;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void ipm_console_receive_callback(void *context, uint32_t id,
|
|
volatile void *data)
|
|
{
|
|
struct device *d;
|
|
struct ipm_console_receiver_runtime_data *driver_data;
|
|
|
|
ARG_UNUSED(data);
|
|
d = context;
|
|
driver_data = d->driver_data;
|
|
if (!sys_ring_buf_put(&driver_data->rb, 0, id, NULL, 0)) {
|
|
nano_isr_sem_give(&driver_data->sem);
|
|
}
|
|
}
|
|
|
|
|
|
int ipm_console_receiver_init(struct device *d)
|
|
{
|
|
struct ipm_console_receiver_config_info *config_info =
|
|
d->config->config_info;
|
|
struct ipm_console_receiver_runtime_data *driver_data = d->driver_data;
|
|
struct device *ipm;
|
|
|
|
ipm = device_get_binding(config_info->bind_to);
|
|
|
|
if (!ipm) {
|
|
printk("unable to bind IPM console receiver to '%s'\n",
|
|
__func__, config_info->bind_to);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (ipm_max_id_val_get(ipm) < 0xFF) {
|
|
printk("IPM driver %s doesn't support 8-bit id values",
|
|
config_info->bind_to);
|
|
return -EINVAL;
|
|
}
|
|
|
|
nano_sem_init(&driver_data->sem);
|
|
sys_ring_buf_init(&driver_data->rb, config_info->rb_size32,
|
|
config_info->ring_buf_data);
|
|
|
|
ipm_register_callback(ipm, ipm_console_receive_callback, d);
|
|
|
|
task_fiber_start(config_info->fiber_stack, IPM_CONSOLE_STACK_SIZE,
|
|
ipm_console_fiber, (int)d, 0,
|
|
IPM_CONSOLE_PRI, 0);
|
|
ipm_set_enabled(ipm, 1);
|
|
|
|
return 0;
|
|
}
|
|
|