2011-11-21 21:35:15 +07:00
|
|
|
/*
|
2011-11-21 23:35:35 +07:00
|
|
|
* libkmod - interface to kernel module operations
|
|
|
|
*
|
|
|
|
* Copyright (C) 2011 ProFUSION embedded systems
|
|
|
|
*
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation version 2.1.
|
|
|
|
*
|
|
|
|
* This library is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
|
|
* License along with this library; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
|
|
*/
|
2011-11-21 21:35:15 +07:00
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <stddef.h>
|
|
|
|
#include <stdarg.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <ctype.h>
|
2011-11-25 01:41:01 +07:00
|
|
|
#include <sys/utsname.h>
|
2011-11-21 21:35:15 +07:00
|
|
|
|
2011-11-21 23:35:35 +07:00
|
|
|
#include "libkmod.h"
|
|
|
|
#include "libkmod-private.h"
|
2011-11-21 21:35:15 +07:00
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* SECTION:libkmod
|
|
|
|
* @short_description: libkmod context
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
|
|
|
* The context contains the default values for the library user,
|
|
|
|
* and is passed to all library operations.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_ctx:
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
|
|
|
* Opaque object representing the library context.
|
|
|
|
*/
|
2011-11-21 23:35:35 +07:00
|
|
|
struct kmod_ctx {
|
2011-11-21 21:35:15 +07:00
|
|
|
int refcount;
|
2011-11-21 23:35:35 +07:00
|
|
|
void (*log_fn)(struct kmod_ctx *ctx,
|
2011-11-21 23:59:23 +07:00
|
|
|
int priority, const char *file, int line,
|
|
|
|
const char *fn, const char *format, va_list args);
|
2011-11-21 21:35:15 +07:00
|
|
|
void *userdata;
|
2011-11-25 01:41:01 +07:00
|
|
|
const char *dirname;
|
2011-11-21 21:35:15 +07:00
|
|
|
int log_priority;
|
2011-11-30 03:07:43 +07:00
|
|
|
struct kmod_config config;
|
2011-11-21 21:35:15 +07:00
|
|
|
};
|
|
|
|
|
2011-11-21 23:35:35 +07:00
|
|
|
void kmod_log(struct kmod_ctx *ctx,
|
2011-11-21 23:59:23 +07:00
|
|
|
int priority, const char *file, int line, const char *fn,
|
|
|
|
const char *format, ...)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
|
|
|
|
va_start(args, format);
|
|
|
|
ctx->log_fn(ctx, priority, file, line, fn, format, args);
|
|
|
|
va_end(args);
|
|
|
|
}
|
|
|
|
|
2011-11-21 23:35:35 +07:00
|
|
|
static void log_stderr(struct kmod_ctx *ctx,
|
2011-11-21 23:59:23 +07:00
|
|
|
int priority, const char *file, int line,
|
|
|
|
const char *fn, const char *format, va_list args)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
2011-11-21 23:35:35 +07:00
|
|
|
fprintf(stderr, "libkmod: %s: ", fn);
|
2011-11-21 21:35:15 +07:00
|
|
|
vfprintf(stderr, format, args);
|
|
|
|
}
|
|
|
|
|
2011-11-25 01:41:01 +07:00
|
|
|
const char *kmod_get_dirname(struct kmod_ctx *ctx)
|
|
|
|
{
|
|
|
|
return ctx->dirname;
|
|
|
|
}
|
|
|
|
|
2011-11-21 21:35:15 +07:00
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_get_userdata:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
|
|
|
* Retrieve stored data pointer from library context. This might be useful
|
|
|
|
* to access from callbacks like a custom logging function.
|
|
|
|
*
|
|
|
|
* Returns: stored userdata
|
|
|
|
**/
|
2011-11-23 20:52:30 +07:00
|
|
|
KMOD_EXPORT void *kmod_get_userdata(const struct kmod_ctx *ctx)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
if (ctx == NULL)
|
|
|
|
return NULL;
|
|
|
|
return ctx->userdata;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_set_userdata:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
* @userdata: data pointer
|
|
|
|
*
|
|
|
|
* Store custom @userdata in the library context.
|
|
|
|
**/
|
2011-11-21 23:35:35 +07:00
|
|
|
KMOD_EXPORT void kmod_set_userdata(struct kmod_ctx *ctx, void *userdata)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
if (ctx == NULL)
|
|
|
|
return;
|
|
|
|
ctx->userdata = userdata;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int log_priority(const char *priority)
|
|
|
|
{
|
|
|
|
char *endptr;
|
|
|
|
int prio;
|
|
|
|
|
|
|
|
prio = strtol(priority, &endptr, 10);
|
|
|
|
if (endptr[0] == '\0' || isspace(endptr[0]))
|
|
|
|
return prio;
|
|
|
|
if (strncmp(priority, "err", 3) == 0)
|
|
|
|
return LOG_ERR;
|
|
|
|
if (strncmp(priority, "info", 4) == 0)
|
|
|
|
return LOG_INFO;
|
|
|
|
if (strncmp(priority, "debug", 5) == 0)
|
|
|
|
return LOG_DEBUG;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-11-25 01:41:01 +07:00
|
|
|
static const char *get_kernel_release(void)
|
|
|
|
{
|
|
|
|
struct utsname u;
|
|
|
|
|
|
|
|
if (uname(&u) < 0)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
return strdup(u.release);
|
|
|
|
}
|
|
|
|
|
2011-11-21 21:35:15 +07:00
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_new:
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
2011-11-21 23:35:35 +07:00
|
|
|
* Create kmod library context. This reads the kmod configuration
|
2011-11-21 21:35:15 +07:00
|
|
|
* and fills in the default values.
|
|
|
|
*
|
|
|
|
* The initial refcount is 1, and needs to be decremented to
|
2011-11-21 23:35:35 +07:00
|
|
|
* release the resources of the kmod library context.
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
2011-11-21 23:35:35 +07:00
|
|
|
* Returns: a new kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
**/
|
2011-11-25 01:41:01 +07:00
|
|
|
KMOD_EXPORT struct kmod_ctx *kmod_new(const char *dirname)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
const char *env;
|
2011-11-22 00:07:27 +07:00
|
|
|
struct kmod_ctx *ctx;
|
2011-11-21 21:35:15 +07:00
|
|
|
|
2011-11-22 00:07:27 +07:00
|
|
|
ctx = calloc(1, sizeof(struct kmod_ctx));
|
|
|
|
if (!ctx)
|
|
|
|
return NULL;
|
2011-11-21 21:35:15 +07:00
|
|
|
|
2011-11-22 00:07:27 +07:00
|
|
|
ctx->refcount = 1;
|
|
|
|
ctx->log_fn = log_stderr;
|
|
|
|
ctx->log_priority = LOG_ERR;
|
2011-11-21 21:35:15 +07:00
|
|
|
|
2011-11-25 01:41:01 +07:00
|
|
|
if (dirname != NULL)
|
|
|
|
ctx->dirname = strdup(dirname);
|
|
|
|
else
|
|
|
|
ctx->dirname = get_kernel_release();
|
|
|
|
|
2011-11-21 21:35:15 +07:00
|
|
|
/* environment overwrites config */
|
2011-11-21 23:35:35 +07:00
|
|
|
env = getenv("KMOD_LOG");
|
2011-11-21 21:35:15 +07:00
|
|
|
if (env != NULL)
|
2011-11-22 00:07:27 +07:00
|
|
|
kmod_set_log_priority(ctx, log_priority(env));
|
2011-11-21 21:35:15 +07:00
|
|
|
|
2011-11-30 03:07:43 +07:00
|
|
|
kmod_parse_config(ctx, &ctx->config);
|
|
|
|
|
2011-11-25 10:05:30 +07:00
|
|
|
INFO(ctx, "ctx %p created\n", ctx);
|
|
|
|
DBG(ctx, "log_priority=%d\n", ctx->log_priority);
|
2011-11-22 00:07:27 +07:00
|
|
|
|
|
|
|
return ctx;
|
2011-11-21 21:35:15 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_ref:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
2011-11-21 23:35:35 +07:00
|
|
|
* Take a reference of the kmod library context.
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
2011-11-21 23:35:35 +07:00
|
|
|
* Returns: the passed kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
**/
|
2011-11-21 23:35:35 +07:00
|
|
|
KMOD_EXPORT struct kmod_ctx *kmod_ref(struct kmod_ctx *ctx)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
if (ctx == NULL)
|
|
|
|
return NULL;
|
|
|
|
ctx->refcount++;
|
|
|
|
return ctx;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_unref:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
2011-11-21 23:35:35 +07:00
|
|
|
* Drop a reference of the kmod library context. If the refcount
|
2011-11-21 21:35:15 +07:00
|
|
|
* reaches zero, the resources of the context will be released.
|
|
|
|
*
|
|
|
|
**/
|
2011-11-21 23:35:35 +07:00
|
|
|
KMOD_EXPORT struct kmod_ctx *kmod_unref(struct kmod_ctx *ctx)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
if (ctx == NULL)
|
|
|
|
return NULL;
|
2011-11-25 00:41:48 +07:00
|
|
|
|
|
|
|
if (--ctx->refcount > 0)
|
2011-11-21 21:35:15 +07:00
|
|
|
return ctx;
|
2011-11-25 10:05:30 +07:00
|
|
|
INFO(ctx, "context %p released\n", ctx);
|
2011-11-25 01:41:01 +07:00
|
|
|
free((char *)ctx->dirname);
|
2011-11-30 03:07:43 +07:00
|
|
|
kmod_free_config(ctx, &ctx->config);
|
2011-11-21 21:35:15 +07:00
|
|
|
free(ctx);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_set_log_fn:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
* @log_fn: function to be called for logging messages
|
|
|
|
*
|
|
|
|
* The built-in logging writes to stderr. It can be
|
|
|
|
* overridden by a custom function, to plug log messages
|
|
|
|
* into the user's logging functionality.
|
|
|
|
*
|
|
|
|
**/
|
2011-11-21 23:35:35 +07:00
|
|
|
KMOD_EXPORT void kmod_set_log_fn(struct kmod_ctx *ctx,
|
2011-11-21 23:59:23 +07:00
|
|
|
void (*log_fn)(struct kmod_ctx *ctx,
|
|
|
|
int priority, const char *file,
|
|
|
|
int line, const char *fn,
|
|
|
|
const char *format, va_list args))
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
ctx->log_fn = log_fn;
|
2011-11-25 10:05:30 +07:00
|
|
|
INFO(ctx, "custom logging function %p registered\n", log_fn);
|
2011-11-21 21:35:15 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_get_log_priority:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
*
|
|
|
|
* Returns: the current logging priority
|
|
|
|
**/
|
2011-11-23 20:52:30 +07:00
|
|
|
KMOD_EXPORT int kmod_get_log_priority(const struct kmod_ctx *ctx)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
return ctx->log_priority;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-11-21 23:35:35 +07:00
|
|
|
* kmod_set_log_priority:
|
|
|
|
* @ctx: kmod library context
|
2011-11-21 21:35:15 +07:00
|
|
|
* @priority: the new logging priority
|
|
|
|
*
|
|
|
|
* Set the current logging priority. The value controls which messages
|
|
|
|
* are logged.
|
|
|
|
**/
|
2011-11-21 23:35:35 +07:00
|
|
|
KMOD_EXPORT void kmod_set_log_priority(struct kmod_ctx *ctx, int priority)
|
2011-11-21 21:35:15 +07:00
|
|
|
{
|
|
|
|
ctx->log_priority = priority;
|
|
|
|
}
|