Wimaxll: add function op-state-get

Signed-off-by: Darius Augulis <augulis.darius@gmail.com>

This patch creates wimaxll API call,
used to get status of Wimax device.
Function op-state-get returns value,
defined in enum wimax_st.

3 files changed, 114 insertions, 0 deletions

diff --git a/include/wimaxll.h b/include/wimaxll.h
index ece869b..24e7250 100644
--- a/include/wimaxll.h
+++ b/include/wimaxll.h
@@ -336,6 +336,7 @@ void wimaxll_msg_free(void *);
 /* generic API */
 int wimaxll_rfkill(struct wimaxll_handle *, enum wimax_rf_state);
 int wimaxll_reset(struct wimaxll_handle *);
+int wimaxll_state_get(struct wimaxll_handle *);
 
 void wimaxll_get_cb_state_change(
 	struct wimaxll_handle *, wimaxll_state_change_cb_f *,
diff --git a/lib/Makefile.am b/lib/Makefile.am
index c42b2c5..77e1cee 100644
--- a/lib/Makefile.am
+++ b/lib/Makefile.am
@@ -17,6 +17,7 @@ libwimaxll_sources = 		\
         op-msg.c		\
         op-reset.c		\
         op-rfkill.c		\
+        op-state-get.c		\
         re-state-change.c	\
 	wimax.c
 
diff --git a/lib/op-state-get.c b/lib/op-state-get.c
new file mode 100644
index 0000000..9822bf8
--- /dev/null
+++ b/lib/op-state-get.c
@@ -0,0 +1,112 @@
+/*
+ * Linux WiMax
+ * Export the kernel's WiMAX stack wimaxll_state_get() function
+ *
+ *
+ * Copyright (C) 2009 Darius Augulis <augulis.darius@gmail.com>
+ *
+ * Based on op-rfkill.c
+ *
+ * Copyright (C) 2007-2008 Intel Corporation. All rights reserved.
+ * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ *   * Redistributions of source code must retain the above copyright
+ *     notice, this list of conditions and the following disclaimer.
+ *   * Redistributions in binary form must reproduce the above copyright
+ *     notice, this list of conditions and the following disclaimer in
+ *     the documentation and/or other materials provided with the
+ *     distribution.
+ *   * Neither the name of Intel Corporation nor the names of its
+ *     contributors may be used to endorse or promote products derived
+ *     from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+ * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+#define _GNU_SOURCE
+#include <sys/types.h>
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <stdarg.h>
+#include <errno.h>
+#include <assert.h>
+#include <linux/types.h>
+#include <netlink/msg.h>
+#include <netlink/netlink.h>
+#include <netlink/genl/genl.h>
+#include <wimaxll.h>
+#include "internal.h"
+#define D_LOCAL 0
+#include "debug.h"
+
+
+/**
+ * Get Wimax device status from kernel and return it to user space
+ *
+ * \param wmx WiMAX device handle
+ *
+ * \return Negative errno code on error. Otherwise, one from Wimax device
+ *     status value, defined in enum wimax_st.
+ *
+ * Allows the caller to get the state of the Wimax device.
+ *
+ * \ingroup device_management
+ * \internal
+ *
+ */
+int wimaxll_state_get(struct wimaxll_handle *wmx)
+{
+	ssize_t result;
+	struct nl_msg *msg;
+
+	result = -EBADF;
+	if (wmx->ifidx == 0)
+		goto error_not_any;
+	msg = nlmsg_new();
+	if (msg == NULL) {
+		result = errno;
+		wimaxll_msg(wmx, "E: STATE_GET: cannot allocate generic"
+			"netlink message: %m\n");
+		goto error_msg_alloc;
+	}
+	if (genlmsg_put(msg, NL_AUTO_PID, NL_AUTO_SEQ,
+			wimaxll_family_id(wmx), 0, 0,
+			WIMAX_GNL_OP_STATE_GET, WIMAX_GNL_VERSION) == NULL) {
+		result = -ENOMEM;
+		wimaxll_msg(wmx, "E: STATE_GET: error preparing message: "
+			  "%d 0x%08x\n", result, result);
+		goto error_msg_prep;
+	}
+	nla_put_u32(msg, WIMAX_GNL_STGET_IFIDX, (__u32) wmx->ifidx);
+	result = nl_send_auto_complete(wmx->nlh_tx, msg);
+	if (result < 0) {
+		wimaxll_msg(wmx, "E: STATE_GET: error sending message: %zd\n",
+			  result);
+		goto error_msg_send;
+	}
+	/* Read the message ACK from netlink */
+	result = wimaxll_wait_for_ack(wmx);
+	if (result < 0 && result != -ENODEV)
+		wimaxll_msg(wmx, "E: STATE_GET: operation failed: %zd\n", result);
+error_msg_prep:
+error_msg_send:
+	nlmsg_free(msg);
+error_msg_alloc:
+error_not_any:
+	d_fnend(3, wmx, "(wmx %p) = %d\n", wmx, result);
+	return result;
+}