Merge pull request #35 from nattgris/store

Pass the read/write intent to the OD store open call

Author: hefloryd

include/co_api.h

@@ -278,6 +278,13 @@ typedef enum co_store
    CO_STORE_LAST,
 } co_store_t;
 
+/** Dictionary store open modes */
+typedef enum co_mode
+{
+   CO_MODE_READ,  /**< Open for reading */
+   CO_MODE_WRITE, /**< Open for writing */
+} co_mode_t;
+
 /** CANopen stack configuration */
 typedef struct co_cfg
 {
@@ -308,7 +315,7 @@ typedef struct co_cfg
    void (*cb_notify) (void * arg, uint16_t index, uint8_t subindex);
 
    /** Function to open dictionary store */
-   void * (*open) (co_store_t store);
+   void * (*open) (co_store_t store, co_mode_t mode);
 
    /** Function to read from dictionary store */
    int (*read) (void * arg, void * data, size_t size);

src/co_lss.c

@@ -266,7 +266,7 @@ static void co_lss_store_configuration (co_net_t * net, uint8_t * _msg)
       goto error1;
    }
 
-   arg = net->open (CO_STORE_LSS);
+   arg = net->open (CO_STORE_LSS, CO_MODE_WRITE);
    if (arg == NULL)
       goto error1;
 
@@ -489,7 +489,7 @@ uint8_t co_lss_get_persistent_node_id (co_net_t * net)
    if (net->open == NULL || net->read == NULL || net->close == NULL)
       goto error1;
 
-   arg = net->open (CO_STORE_LSS);
+   arg = net->open (CO_STORE_LSS, CO_MODE_READ);
    if (arg == NULL)
       goto error1;
 
@@ -521,7 +521,7 @@ int co_lss_get_persistent_bitrate (co_net_t * net)
    if (net->open == NULL || net->read == NULL || net->close == NULL)
       goto error1;
 
-   arg = net->open (CO_STORE_LSS);
+   arg = net->open (CO_STORE_LSS, CO_MODE_READ);
    if (arg == NULL)
       goto error1;
 

src/co_main.h

@@ -278,7 +278,7 @@ struct co_net
    void (*cb_notify) (void * arg, uint16_t index, uint8_t subindex);
 
    /** Function to open dictionary store */
-   void * (*open) (co_store_t store);
+   void * (*open) (co_store_t store, co_mode_t mode);
 
    /** Function to read from dictionary store */
    int (*read) (void * arg, void * data, size_t size);

src/co_od.c

@@ -359,7 +359,7 @@ uint32_t co_od_load (co_net_t * net, co_store_t store)
    if (net->open == NULL || net->read == NULL || net->close == NULL)
       return CO_SDO_ABORT_GENERAL;
 
-   arg = net->open (store);
+   arg = net->open (store, CO_MODE_READ);
    if (arg == NULL)
       return CO_SDO_ABORT_GENERAL;
 
@@ -384,19 +384,19 @@ uint32_t co_od_load (co_net_t * net, co_store_t store)
       if (net->read (arg, &subindex, sizeof (subindex)) < 0)
          goto error;
 
-      if (net->read (arg, &size, sizeof (size)) < 0)
+      if (net->read (arg, &size, sizeof (size)) < 0 || size == 0)
          goto error;
 
       /* Attempt to set value. Errors are ignored to support firmware
          update of dictionary */
 
       obj = co_obj_find (net, index);
       if (obj == NULL)
-         continue;
+         goto skip;
 
       entry = co_entry_find (net, obj, subindex);
-      if (entry == NULL || !(entry->flags & OD_WRITE))
-         continue;
+      if (entry == NULL || !(entry->flags & OD_WRITE) || (entry->flags & OD_TRANSIENT))
+         goto skip; /* Not storable in this OD */
 
       if (size <= sizeof (value))
       {
@@ -418,16 +418,20 @@ uint32_t co_od_load (co_net_t * net, co_store_t store)
       else
       {
          /* Stored size does not match object size. Discard data. */
-         while (size > sizeof(value))
-         {
-            if (net->read (arg, &value, sizeof (value)) < 0)
-               goto error;
-            size -= sizeof(value);
-         }
+         goto skip;
+      }
 
-         if (net->read (arg, &value, size) < 0)
+      continue;
+   skip:
+      while (size > sizeof (value))
+      {
+         if (net->read (arg, &value, sizeof (value)) < 0)
             goto error;
+         size -= sizeof (value);
       }
+
+      if (net->read (arg, &value, size) < 0)
+         goto error;
    }
 
    /* Ignore any error on close */
@@ -457,7 +461,7 @@ uint32_t co_od_store (co_net_t * net, co_store_t store, uint16_t min, uint16_t m
    if (net->open == NULL || net->write == NULL || net->close == NULL)
       return CO_SDO_ABORT_HW_ERROR;
 
-   arg = net->open (store);
+   arg = net->open (store, CO_MODE_WRITE);
    if (arg == NULL)
       return CO_SDO_ABORT_HW_ERROR;
 
@@ -555,7 +559,7 @@ uint32_t co_od_restore (co_net_t * net, co_store_t store)
    if (net->open == NULL || net->write == NULL || net->close == NULL)
       return CO_SDO_ABORT_HW_ERROR;
 
-   arg = net->open (store);
+   arg = net->open (store, CO_MODE_WRITE);
    if (arg == NULL)
       return CO_SDO_ABORT_HW_ERROR;
 

test/mocks.cpp

@@ -187,7 +187,7 @@ void store_init (void)
 }
 
 unsigned int store_open_calls;
-void * store_open (co_store_t store)
+void * store_open (co_store_t store, co_mode_t mode)
 {
    store_open_calls++;
    _fd.p = the_store;

test/mocks.h

@@ -108,7 +108,7 @@ void cb_notify (void * arg, uint16_t index, uint8_t subindex);
 
 void store_init (void);
 extern unsigned int store_open_calls;
-void * store_open (co_store_t store);
+void * store_open (co_store_t store, co_mode_t mode);
 int store_read (void * arg, void * data, size_t size);
 int store_write (void * arg, const void * data, size_t size);
 int store_close (void * arg);

util/slave/slave.c

@@ -158,7 +158,7 @@ static struct fd
    uint8_t * p;
 } fd;
 
-static void * store_open (co_store_t store)
+static void * store_open (co_store_t store, co_mode_t mode)
 {
    if (store >= CO_STORE_LAST)
       return NULL;