diff --git a/Makefile.am b/Makefile.am
index c6d8e02941c1d17baf9a46cf97f0569215ef153f..d0c4ead0c18e53416776e71a64265b4f84af253b 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -1,3 +1,8 @@
bin_PROGRAMS = gbridge
-gbridge_SOURCES = main.c
\ No newline at end of file
+gbridge_CFLAGS = -Wall -Werror -I${GBDIR}
+gbridge_CFLAGS += `pkg-config --cflags libnl-3.0 libnl-genl-3.0`
+
+gbridge_SOURCES = main.c \
+ netlink.c \
+ debug.c
\ No newline at end of file
diff --git a/configure.ac b/configure.ac
index ecc826631a743e7f232fdc4cdcb7f0662eff900e..8875569daf27b0a5470c2ca0961abf9c07f7f08a 100644
--- a/configure.ac
+++ b/configure.ac
@@ -9,8 +9,10 @@ AM_INIT_AUTOMAKE
AC_PROG_CC
AC_PROG_INSTALL
-# Checks for library functions.
-AC_CHECK_FUNCS([memset mkdir strerror strtol])
+# Checks for libraries.
+AC_CHECK_LIB([nl-3], [nl_socket_alloc])
+AC_CHECK_LIB([nl-genl-3], [genl_register_family])
+AC_CHECK_LIB([pthread], [pthread_create])
AC_CONFIG_SRCDIR([main.c])
AC_CONFIG_HEADERS([config.h])
@@ -18,4 +20,9 @@ AC_CONFIG_FILES([
Makefile
])
+AC_ARG_VAR([GBDIR], ["greybus sources directory"])
+AS_IF([test "$GBDIR" = ""], [
+ AC_MSG_ERROR([Environment variable GBDIR needs to be set])
+])
+
AC_OUTPUT
diff --git a/debug.c b/debug.c
new file mode 100644
index 0000000000000000000000000000000000000000..c8c8564e04fcc23e3a9acfbfbe83ead8b35e0f6b
--- /dev/null
+++ b/debug.c
@@ -0,0 +1,26 @@
+/*
+ * GBridge (Greybus Bridge)
+ * Copyright (c) 2016 Alexandre Bailon
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+
+ * This program 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 General Public License for more details.
+
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <debug.h>
+
+int log_level = 0;
+
+void set_log_level(int ll)
+{
+ log_level = ll;
+}
diff --git a/debug.h b/debug.h
new file mode 100644
index 0000000000000000000000000000000000000000..7f2b4c7aac8d75e6483136d6c8705e34795b4126
--- /dev/null
+++ b/debug.h
@@ -0,0 +1,54 @@
+/*
+ * GBridge (Greybus Bridge)
+ * Copyright (c) 2016 Alexandre Bailon
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+
+ * This program 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 General Public License for more details.
+
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#ifndef _DEBUG_H_
+#define _DEBUG_H_
+
+#include <stdio.h>
+
+enum log_level {
+ LL_ERROR = 0,
+ LL_WARNING,
+ LL_INFO,
+ LL_DEBUG,
+ LL_VERBOSE
+};
+
+#define ll_print(ll, format, ...) \
+ do { \
+ if (log_level >= ll) \
+ printf(format, ##__VA_ARGS__); \
+ } while (0)
+
+#define pr_err(format, ...) \
+ ll_print(LL_ERROR, format, ##__VA_ARGS__)
+
+#define pr_warn(format, ...) \
+ ll_print(LL_WARNING, format, ##__VA_ARGS__)
+
+#define pr_info(format, ...) \
+ ll_print(LL_INFO, format, ##__VA_ARGS__)
+
+#define pr_dbg(format, ...) \
+ ll_print(LL_DEBUG, format, ##__VA_ARGS__)
+
+extern int log_level;
+
+void set_log_level(int ll);
+
+#endif /* _DEBUG_H_ */
diff --git a/gbridge.h b/gbridge.h
new file mode 100644
index 0000000000000000000000000000000000000000..b820da0658b3e52f2dc618ebbc7f7df1736fc284
--- /dev/null
+++ b/gbridge.h
@@ -0,0 +1,38 @@
+/*
+ * GBridge (Greybus Bridge)
+ * Copyright (c) 2016 Alexandre Bailon
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+
+ * This program 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 General Public License for more details.
+
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#ifndef _GBRIDGE_H_
+#define _GBRIDGE_H_
+
+#include <stdint.h>
+#include <linux/types.h>
+#include <sys/queue.h>
+
+#define __packed __attribute__((__packed__))
+
+/* Include kernel headers */
+#include <greybus.h>
+#include <greybus_protocols.h>
+#include <gb_netlink.h>
+
+#define SVC_CPORT 0
+
+#define gb_operation_msg_size(hdr) \
+ le16toh(((struct gb_operation_msg_hdr *)(hdr))->size)
+
+#endif /* _GBRIDGE_H_ */
diff --git a/main.c b/main.c
index f5f8ce81551de7c45ea67c3bba528f1d8dae9776..c3ecaf13c7895479ccadf24251cb8b0d7afa2d5e 100644
--- a/main.c
+++ b/main.c
@@ -16,7 +16,32 @@
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
+#include <signal.h>
+
+#include <debug.h>
+#include "netlink.h"
+
+static void signal_handler(int sig)
+{
+ netlink_cancel();
+}
+
int main(int argc, char *argv[])
{
+ int ret;
+
+ signal(SIGINT, signal_handler);
+ signal(SIGHUP, signal_handler);
+ signal(SIGTERM, signal_handler);
+
+ ret = netlink_init();
+ if (ret) {
+ pr_err("Failed to init netlink\n");
+ return ret;
+ }
+
+ netlink_loop();
+ netlink_exit();
+
return 0;
-}
\ No newline at end of file
+}
diff --git a/netlink.c b/netlink.c
new file mode 100644
index 0000000000000000000000000000000000000000..a1222c0939ad66901f4277d3813b3997318b2c13
--- /dev/null
+++ b/netlink.c
@@ -0,0 +1,194 @@
+/*
+ * GBridge (Greybus Bridge)
+ * Copyright (c) 2016 Alexandre Bailon
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+
+ * This program 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 General Public License for more details.
+
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <errno.h>
+#include <pthread.h>
+
+#include <debug.h>
+#include <gbridge.h>
+
+#include <netlink/genl/mngt.h>
+#include <netlink/genl/ctrl.h>
+#include <netlink/genl/genl.h>
+
+static struct nl_sock *sock;
+static pthread_t nl_recv_thread;
+static struct nla_policy gb_nl_policy[GB_NL_A_MAX + 1] = {
+ [GB_NL_A_DATA] = {.type = NLA_BINARY,.maxlen = GB_NETLINK_MTU},
+ [GB_NL_A_CPORT] = {.type = NLA_U32},
+};
+
+static int
+parse_gb_nl_msg(struct nl_cache_ops *unused, struct genl_cmd *cmd,
+ struct genl_info *info, void *arg)
+{
+ struct gb_operation_msg_hdr *hdr;
+ uint16_t hd_cport_id;
+ size_t len;
+
+ if (!info->attrs[GB_NL_A_DATA] || !info->attrs[GB_NL_A_CPORT])
+ return -EPROTO;
+
+ hd_cport_id = nla_get_u32(info->attrs[GB_NL_A_CPORT]);
+ len = nla_len(info->attrs[GB_NL_A_DATA]);
+ hdr = nla_data(info->attrs[GB_NL_A_DATA]);
+
+ if (len < sizeof(*hdr)) {
+ pr_err("short message received\n");
+ return -EPROTO;
+ }
+
+ if (hd_cport_id == SVC_CPORT) {
+ /* TODO: handle SVC operations */
+ } else {
+ /* TODO: transfer data to modules */
+ }
+
+ return 0;
+}
+
+static struct genl_cmd cmds[] = {
+ {
+ .c_id = GB_NL_C_MSG,
+ .c_name = "gb_nl_msg()",
+ .c_maxattr = GB_NL_A_MAX,
+ .c_attr_policy = gb_nl_policy,
+ .c_msg_parser = &parse_gb_nl_msg,
+ },
+};
+
+#define ARRAY_SIZE(X) (sizeof(X) / sizeof((X)[0]))
+
+static struct genl_ops ops = {
+ .o_name = GB_NL_NAME,
+ .o_cmds = cmds,
+ .o_ncmds = ARRAY_SIZE(cmds),
+};
+
+int netlink_send(uint16_t hd_cport_id, void *data, size_t len)
+{
+ struct nl_data *nl_data;
+ struct nl_msg *msg;
+ void *hdr;
+ int ret;
+
+ msg = nlmsg_alloc();
+ if (!msg) {
+ pr_err("Failed to allocate netlink message\n");
+ ret = -ENOMEM;
+ goto err_msg_free;
+ }
+
+ hdr = genlmsg_put(msg, NL_AUTO_PORT, NL_AUTO_SEQ, ops.o_id,
+ 0, 0, GB_NL_C_MSG, 0);
+ if (!hdr) {
+ pr_err("Failed to write header\n");
+ ret = -ENOMEM;
+ goto err_msg_free;
+ }
+
+ nl_data = nl_data_alloc(data, len);
+ if (!nl_data) {
+ pr_err("Failed to allocate data\n");
+ ret = -ENOMEM;
+ goto err_msg_free;
+ }
+
+ nla_put_u32(msg, GB_NL_A_CPORT, hd_cport_id);
+ nla_put_data(msg, GB_NL_A_DATA, nl_data);
+ ret = nl_send_auto(sock, msg);
+ if (ret < 0)
+ pr_err("Failed to send message: %s\n", nl_geterror(ret));
+
+ nl_data_free(nl_data);
+
+ return 0;
+
+ err_msg_free:
+ nlmsg_free(msg);
+
+ return ret;
+}
+
+void *nl_recv_cb(void *data)
+{
+ int ret;
+
+ while (1) {
+ ret = nl_recvmsgs_default(sock);
+ if (ret < 0) {
+ pr_err("Failed to receive message: %s\n",
+ nl_geterror(ret));
+ }
+ }
+
+ return NULL;
+}
+
+int events_cb(struct nl_msg *msg, void *arg)
+{
+ return genl_handle_msg(msg, arg);
+}
+
+int netlink_init(void)
+{
+ int ret;
+
+ sock = nl_socket_alloc();
+ nl_socket_set_local_port(sock, GB_NL_PID);
+ nl_socket_disable_seq_check(sock);
+ nl_socket_disable_auto_ack(sock);
+ nl_socket_modify_cb(sock, NL_CB_VALID, NL_CB_CUSTOM, events_cb, NULL);
+ nl_connect(sock, NETLINK_GENERIC);
+
+ ret = genl_register_family(&ops);
+ if (ret < 0) {
+ pr_err("Failed to register family\n");
+ goto error;
+ }
+
+ ret = genl_ops_resolve(sock, &ops);
+ if (ret < 0) {
+ pr_err("Failed to resolve family name\n");
+ goto error;
+ }
+
+ return pthread_create(&nl_recv_thread, NULL, nl_recv_cb, NULL);
+
+ error:
+ nl_close(sock);
+ nl_socket_free(sock);
+
+ return ret;
+}
+
+void netlink_loop(void)
+{
+ pthread_join(nl_recv_thread, NULL);
+}
+
+void netlink_cancel(void)
+{
+ pthread_cancel(nl_recv_thread);
+}
+
+void netlink_exit(void)
+{
+ nl_close(sock);
+ nl_socket_free(sock);
+}
diff --git a/netlink.h b/netlink.h
new file mode 100644
index 0000000000000000000000000000000000000000..b12c7a7239a964ae296228e80cfc743ea4ec7a3b
--- /dev/null
+++ b/netlink.h
@@ -0,0 +1,31 @@
+/*
+ * GBridge (Greybus Bridge)
+ * Copyright (c) 2016 Alexandre Bailon
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+
+ * This program 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 General Public License for more details.
+
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#ifndef _GBRIDGE_NETLINK_H_
+#define _GBRIDGE_NETLINK_H_
+
+#include <stdint.h>
+
+int netlink_init(void);
+void netlink_cancel(void);
+void netlink_exit(void);
+void netlink_loop(void);
+
+int netlink_send(uint16_t cport_id, void *data, size_t len);
+
+#endif /* _GBRIDGE_NETLINK_H_ */