diff options
Diffstat (limited to 'src/procfs/dlt-procfs-interrupt.c')
| -rw-r--r-- | src/procfs/dlt-procfs-interrupt.c | 147 |
1 files changed, 147 insertions, 0 deletions
diff --git a/src/procfs/dlt-procfs-interrupt.c b/src/procfs/dlt-procfs-interrupt.c new file mode 100644 index 0000000..10d8823 --- /dev/null +++ b/src/procfs/dlt-procfs-interrupt.c @@ -0,0 +1,147 @@ +/* + * @licence app begin@ + * SPDX license identifier: MPL-2.0 + * + * Copyright (C) 2011-2015, BMW AG + * + * This file is part of GENIVI Project DLT - Diagnostic Log and Trace. + * + * This Source Code Form is subject to the terms of the + * Mozilla Public License (MPL), v. 2.0. + * If a copy of the MPL was not distributed with this file, + * You can obtain one at http://mozilla.org/MPL/2.0/. + * + * For further information see http://www.genivi.org/. + * @licence end@ + */ + +/*! + * \author Sven Hassler <sven_hassler@mentor.com> + * + * \copyright Copyright © 2011-2015 BMW AG. \n + * License MPL-2.0: Mozilla Public License version 2.0 http://mozilla.org/MPL/2.0/. + * + * \file dlt-procfs-interrupt.c + */ + +#include "dlt-procfs-interrupt.h" + +DltReturnValue dlt_procfs_log_interrupts(DltContext *ctx, DltLogLevelType log_level) +{ + if(ctx == NULL) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): Nullpointer parameter\n"); + return DLT_RETURN_WRONG_PARAMETER; + } + + char buffer[BUFFER_SIZE]; + *buffer = '\0'; + + char file_buffer[BUFFER_SIZE]; + char *token, *delim = " \t", *delim2 = " \t\n", *check; + int head_line = 1, first_row = 1, cpu_count = 0, column = 0, buffer_offset = 0; + DltReturnValue ret; + + if((ret = dlt_procfs_read_file("/proc/interrupts", file_buffer, BUFFER_SIZE)) < DLT_RETURN_OK) return ret; + + token = strtok(file_buffer, delim); + while(token != NULL) + { + if(head_line) + { + if(strlen(token) > 3 && token[0]=='C' && token[1]=='P' && token[2]=='U') + cpu_count++; + else if(cpu_count <= 0) + { + fprintf(stderr, "dlt_procfs_log_interrupts: Could not parse CPU count\n"); + return DLT_RETURN_ERROR; + } + else if(strcmp(token, "\n") == 0) + head_line = 0; + + token = strtok(NULL, delim); + } + else + { + int tokenlen = strlen(token); + if(token[tokenlen - 1] == ':') + { + column = 0; + + if(first_row) + first_row = 0; + else + buffer_offset += snprintf(buffer + buffer_offset, BUFFER_SIZE - buffer_offset, "\n"); + } + + if(column == 0) // IRQ number + { + buffer_offset += snprintf(buffer + buffer_offset, BUFFER_SIZE - buffer_offset, "%.*s;", tokenlen-1, token); + } + else if(column <= cpu_count) + { + long int interrupt_count = strtol(token, &check, 10); + if(*check != '\0') + { + fprintf(stderr, "dlt_procfs_log_interrupts: Could not parse interrupt count for CPU %d\n", column - 1); + return DLT_RETURN_ERROR; + } + + buffer_offset += snprintf(buffer + buffer_offset, BUFFER_SIZE - buffer_offset, "cpu%d:%ld;", column - 1, interrupt_count); + } + + column++; + + token = strtok(NULL, delim2); + } + } + + DltContextData ctx_data; + if((ret = dlt_user_log_write_start(ctx, &ctx_data, log_level)) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_start() returned error\n"); + return ret; + } + + if((ret = dlt_user_log_write_string(&ctx_data, "IRQ")) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_string() returned error\n"); + return ret; + } + + token = strtok(buffer, "\n"); + while(token != NULL) + { + if(dlt_user_log_write_string(&ctx_data, token) < DLT_RETURN_OK) + { + /* message buffer full, start new one */ + if((ret = dlt_user_log_write_finish(&ctx_data)) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_finish() returned error\n"); + return ret; + } + + if((ret = dlt_user_log_write_start(ctx, &ctx_data, log_level)) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_start() returned error\n"); + return ret; + } + + if((ret = dlt_user_log_write_string(&ctx_data, "IRQ")) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_string() returned error\n"); + return ret; + } + } + else + token = strtok(NULL, "\n"); + } + + if((ret = dlt_user_log_write_finish(&ctx_data)) < DLT_RETURN_OK) + { + fprintf(stderr, "dlt_procfs_log_interrupts(): dlt_user_log_write_finish() returned error\n"); + return ret; + } + + return DLT_RETURN_OK; +} |