Added ec_slave_get_sdo_by_pos_const() and ec_slave_sdo_count().
authorFlorian Pose <fp@igh-essen.com>
Fri, 06 Jun 2008 09:22:57 +0000
changeset 964 957f21465052
parent 963 01702c78fe0a
child 965 1aee4aa1def3
Added ec_slave_get_sdo_by_pos_const() and ec_slave_sdo_count().
master/slave.c
master/slave.h
--- a/master/slave.c	Fri Jun 06 09:22:19 2008 +0000
+++ b/master/slave.c	Fri Jun 06 09:22:57 2008 +0000
@@ -1193,7 +1193,7 @@
  */
 
 ec_sdo_t *ec_slave_get_sdo(
-        ec_slave_t *slave /**< EtherCAT slave */,
+        ec_slave_t *slave, /**< EtherCAT slave */
         uint16_t index /**< Sdo index */
         )
 {
@@ -1209,6 +1209,48 @@
 
 /*****************************************************************************/
 
+/** Get an Sdo from the dictionary, given its position in the list.
+ * \returns The desired Sdo, or NULL.
+ */
+
+const ec_sdo_t *ec_slave_get_sdo_by_pos_const(
+        const ec_slave_t *slave, /**< EtherCAT slave. */
+        uint16_t sdo_position /**< Sdo list position. */
+        )
+{
+    const ec_sdo_t *sdo;
+
+    list_for_each_entry(sdo, &slave->sdo_dictionary, list) {
+        if (sdo_position--)
+            continue;
+        return sdo;
+    }
+
+    return NULL;
+}
+
+/*****************************************************************************/
+
+/** Get the number of Sdos in the dictionary.
+ * \returns Sdo count.
+ */
+
+uint16_t ec_slave_sdo_count(
+        const ec_slave_t *slave /**< EtherCAT slave. */
+        )
+{
+    const ec_sdo_t *sdo;
+    uint16_t count = 0;
+
+    list_for_each_entry(sdo, &slave->sdo_dictionary, list) {
+        count++;
+    }
+
+    return count;
+}
+
+/*****************************************************************************/
+
 /** Finds a mapped Pdo.
  * \returns The desired Pdo object, or NULL.
  */
--- a/master/slave.h	Fri Jun 06 09:22:19 2008 +0000
+++ b/master/slave.h	Fri Jun 06 09:22:57 2008 +0000
@@ -223,6 +223,8 @@
 void ec_slave_sdo_dict_info(const ec_slave_t *,
         unsigned int *, unsigned int *);
 ec_sdo_t *ec_slave_get_sdo(ec_slave_t *, uint16_t);
+const ec_sdo_t *ec_slave_get_sdo_by_pos_const(const ec_slave_t *, uint16_t);
+uint16_t ec_slave_sdo_count(const ec_slave_t *);
 const ec_pdo_t *ec_slave_find_pdo(const ec_slave_t *, uint16_t);
 
 /*****************************************************************************/