Nouveaux Flags + valueAdd()

Nouveaux Flags
Néthode pour ajouter des valeurs à la liste chaînée)
Correction d'un bug sur les listes chaînées

LibTeleinfo.cpp

@@ -129,15 +129,50 @@ uint8_t TInfo::clearBuffer()
 	_recv_idx = 0;
 }
 
+
+/* ======================================================================
+Function: addCustomValue
+Purpose : let user add custom values (mainly for testing)
+Input   : Pointer to the label name
+          pointer to the value
+          pointer on flag state of the label 
+Output  : pointer to the new node (or founded one)
+Comments: checksum is calculated before adding, no need to bother with
+====================================================================== */
+ValueList * TInfo::addCustomValue(char * name, char * value, uint8_t * flags)
+{
+  // Little check
+  if (name && *name && value && *value) 
+  {
+    ValueList * me;
+
+    // Same as if we really received this line
+    customLabel(name, value, flags);
+    me = valueAdd(name, value, calcChecksum(name,value), flags);
+
+    if ( me ) {
+      // something to do with new datas
+      if (*flags & (TINFO_FLAGS_UPDATED | TINFO_FLAGS_ADDED | TINFO_FLAGS_ALERT) ) {
+        // this frame will for sure be updated
+        _frame_updated = true;
+      }
+      return (me);
+    }
+  }
+
+  // Error or Already Exists
+  return ( (ValueList *) NULL);
+}
+
 /* ======================================================================
 Function: valueAdd
 Purpose : Add element to the Linked List of values
 Input   : Pointer to the label name
           pointer to the value
           checksum value
-            state of the label (filled by function)
+          flag state of the label (modified by function)
 Output  : pointer to the new node (or founded one)
-            state of the label changed by the function
+Comments: - state of the label changed by the function
 ====================================================================== */
 ValueList * TInfo::valueAdd(char * name, char * value, uint8_t checksum, uint8_t * flags)
 {
@@ -146,19 +181,25 @@ ValueList * TInfo::valueAdd(char * name, char * value, uint8_t checksum, uint8_t
 
 	uint8_t lgname = strlen(name);
 	uint8_t lgvalue = strlen(value);
+  uint8_t thischeck = calcChecksum(name,value);
   
-  // clear flags
+  // just some paranoia 
-  *flags = TINFO_FLAGS_NONE ;
+  if (thischeck != checksum ) {
-
+    TI_Debug(name);
+    TI_Debug('=');
+    TI_Debug(value);
+    TI_Debug(F(" '"));
+    TI_Debug((char) cheksum);
+    TI_Debug(F("' Not added bad checksum calulated '"));
+    TI_Debug((char) thischeck);
+    TI_Debugln(F("'"));
+  } else  {
     // Got one and all seems good ?
     if (me && lgname && lgvalue && checksum) {
       // Create pointer on the new node
       ValueList *newNode = NULL;
       ValueList *parNode = NULL ;
 
-    // By default we done nothing
-    *flags = TINFO_FLAGS_NOTHING;
-
       // Loop thru the node
       while (me->next) {
         // save parent node
@@ -171,13 +212,13 @@ ValueList * TInfo::valueAdd(char * name, char * value, uint8_t checksum, uint8_t
         if (strncmp(me->name, name, lgname) == 0) {
           // Already got also this value, return US
           if (strncmp(me->value, value, lgvalue) == 0) {
-          me->flags = TINFO_FLAGS_EXIST;
+            *flags |= TINFO_FLAGS_EXIST;
-          *flags = me->flags;
+            me->flags = *flags;
             return ( me );
           } else {
             // We changed the value
-          me->flags = TINFO_FLAGS_UPDATED;
+            *flags |= TINFO_FLAGS_UPDATED;
-          *flags = me->flags;
+            me->flags = *flags ;
             // Do we have enought space to hold new value ?
             if (strlen(me->value) >= lgvalue ) {
               // Copy it
@@ -187,14 +228,16 @@ ValueList * TInfo::valueAdd(char * name, char * value, uint8_t checksum, uint8_t
               // That's all
               return (me);
             } else {
-            // indicate parent node next following node instead of me
+              // indicate our parent node that the next node
+              // is not us anymore but the next we have
               parNode->next = me->next;
 
-            // Return to parent (that will now point on next node and not us)
-            me = parNode;
-
               // free up this node
               free (me);
+
+              // Return to parent (that will now point on next node and not us)
+              // and continue loop just in case we have sevral with same name
+              me = parNode;
             }
           }
         }
@@ -226,20 +269,117 @@ ValueList * TInfo::valueAdd(char * name, char * value, uint8_t checksum, uint8_t
 
       // So we just created this node but was it new
       // or was matter of text size ?
-    if (*flags != TINFO_FLAGS_UPDATED) {
+      if ( (*flags & TINFO_FLAGS_UPDATED) == 0) {
         // so we added this node !
-        newNode->flags = TINFO_FLAGS_ADDED;
+        *flags |= TINFO_FLAGS_ADDED ;
-        *flags = newNode->flags  ;
+        newNode->flags = *flags;
       }
 
       // return pointer on the new node
       return (newNode);
     }
 
+  } // Checksum OK
+
+
   // Error or Already Exists
   return ( (ValueList *) NULL);
 }
 
+
+
+/* ======================================================================
+Function: valueRemoveFlagged
+Purpose : remove element to the Linked List of values where 
+Input   : paramter flags
+Output  : true if found and removed
+Comments: -
+====================================================================== */
+boolean TInfo::valueRemoveFlagged(uint8_t flags)
+{
+  boolean deleted = false;
+
+  // Get our linked list 
+  ValueList * me = &_valueslist;
+  ValueList *parNode = NULL ;
+
+  // Got one and all seems good ?
+  if (me) {
+    // Loop thru the node
+    while (me->next) {
+      // save parent node
+      parNode = me ;
+
+      // go to next node
+      me = me->next;
+
+      // found the flags?
+      if (me->flags & flags ) {
+        // indicate our parent node that the next node
+        // is not us anymore but the next we have
+        parNode->next = me->next;
+
+        // free up this node
+        free (me);
+
+        // Return to parent (that will now point on next node and not us)
+        // and continue loop just in case we have sevral with same name
+        me = parNode;
+        deleted = true;
+      }
+    }
+  }
+
+  return (deleted);
+}
+
+/* ======================================================================
+Function: valueRemove
+Purpose : remove element to the Linked List of values
+Input   : Pointer to the label name
+Output  : true if found and removed
+Comments: -
+====================================================================== */
+boolean TInfo::valueRemove(char * name)
+{
+  boolean deleted = false;
+
+  // Get our linked list 
+  ValueList * me = &_valueslist;
+  ValueList *parNode = NULL ;
+
+  uint8_t lgname = strlen(name);
+
+  // Got one and all seems good ?
+  if (me && lgname) {
+    // Loop thru the node
+    while (me->next) {
+      // save parent node
+      parNode = me ;
+
+      // go to next node
+      me = me->next;
+
+      // found ?
+      if (strncmp(me->name, name, lgname) == 0) {
+        // indicate our parent node that the next node
+        // is not us anymore but the next we have
+        parNode->next = me->next;
+
+        // free up this node
+        free (me);
+
+        // Return to parent (that will now point on next node and not us)
+        // and continue loop just in case we have sevral with same name
+        me = parNode;
+        deleted = true;
+      }
+    }
+  }
+
+  return (deleted);
+}
+
 /* ======================================================================
 Function: valueGet
 Purpose : get value of one element
@@ -331,7 +471,8 @@ uint8_t TInfo::valuesDump(void)
 
       // Flags management
       if ( me->flags) {
-        TI_Debug(F("Flags : ")); 
+        TI_Debug(F("Flags:0x")); 
+        TI_Debugf("%02X =>", me->flags); 
         if ( me->flags & TINFO_FLAGS_EXIST)
           TI_Debug(F("Exist ")) ;
         if ( me->flags & TINFO_FLAGS_UPDATED)
@@ -434,22 +575,37 @@ unsigned char TInfo::calcChecksum(char *etiquette, char *valeur)
 Function: customLabel
 Purpose : do action when received a correct label / value + checksum line
 Input   : plabel : pointer to string containing the label
-        : pvalue : pointer to string containing the associated value
+          pvalue : pointer to string containing the associated value
+          pflags pointer in flags value if we need to cchange it
 Output  : 
 Comments: 
 ====================================================================== */
-void TInfo::customLabel( char * plabel, char * pvalue) 
+void TInfo::customLabel( char * plabel, char * pvalue, uint8_t * pflags) 
 {
-  // Traitement de l'ADPS demandé
+  int8_t phase = -1;
-	if (_fn_ADPS) {
+
   // Monophasé
   if (strcmp(plabel, "ADPS")==0 ) 
-			_fn_ADPS(0);
+    phase=0;
+
+  // For testing
+  //if (strcmp(plabel, "IINST")==0 ) {
+  //  *pflags |= TINFO_FLAGS_ALERT;
+  //}
 
 	// triphasé c'est ADIR + Num Phase
 	if (plabel[0]=='A' && plabel[1]=='D' && plabel[2]=='I' && plabel[3]=='R' )
 		if (plabel[4]>='1' && plabel[4]<='3') 
-				_fn_ADPS(plabel[4]-'0');
+   	  phase = plabel[4]-'0';
+
+  // Nous avons un ADPS ?
+  if (phase>=0 && phase <=3) {
+    // ne doit pas être sauvé définitivement
+    *pflags |= TINFO_FLAGS_ALERT;
+  
+    // Traitement de l'ADPS demandé par le sketch
+    if (_fn_ADPS) 
+      _fn_ADPS(phase);
   }
 }
 
@@ -468,7 +624,7 @@ ValueList * TInfo::checkLine(char * pline)
   char * pvalue;
   char   checksum;
   char  buff[TINFO_BUFSIZE];
-  uint8_t flags;
+  uint8_t flags  = TINFO_FLAGS_NONE;
   boolean err = true ;	// Assume  error
   int len ; // Group len
 
@@ -524,7 +680,7 @@ ValueList * TInfo::checkLine(char * pline)
 	        // Is checksum is OK
 	        if ( calcChecksum(ptok,pvalue) == checksum) {
 	          // In case we need to do things on specific labels
-	          customLabel(ptok, pvalue);
+	          customLabel(ptok, pvalue, &flags);
 
 	          // Add value to linked lists of values
 	          ValueList * me = valueAdd(ptok, pvalue, checksum, &flags);
@@ -532,7 +688,7 @@ ValueList * TInfo::checkLine(char * pline)
 	          // value correctly added/changed
 	          if ( me ) {
 				      // something to do with new datas
-			        if (flags & (TINFO_FLAGS_UPDATED | TINFO_FLAGS_ADDED) ) {
+			        if (flags & (TINFO_FLAGS_UPDATED | TINFO_FLAGS_ADDED | TINFO_FLAGS_ALERT) ) {
 			        	// this frame will for sure be updated
 			        	_frame_updated = true;
 
@@ -596,6 +752,15 @@ _State_e TInfo::process(char c)
 		  		_fn_updated_frame(me);
 		  	else if (_fn_new_frame)
 	  			_fn_new_frame(me);
+
+        #ifdef TI_Debug
+          valuesDump();
+        #endif
+
+        // It's important there since all user job is done
+        // to remove the alert flags from table (ADPS for example)
+        // it will be put back again next time if any
+        valueRemoveFlagged(TINFO_FLAGS_ALERT);
 	  	}
 
 	  	// We were waiting fo this one ?

LibTeleinfo.h

@@ -90,9 +90,10 @@ enum _State_e {
 #define TINFO_FLAGS_ADDED    0x02
 #define TINFO_FLAGS_EXIST    0x04
 #define TINFO_FLAGS_UPDATED  0x08
-#define TINFO_FLAGS_ALERT   0x10
+#define TINFO_FLAGS_ALERT    0x80 /* This will generate an alert */
 
 // Local buffer for one line of teleinfo 
+// maximum size, I think it should be enought
 #define TINFO_BUFSIZE  64
 
 // Teleinfo start and end of frame characters
@@ -111,6 +112,7 @@ class TInfo
     void        attachData(void (*_fn_data)(ValueList * valueslist, uint8_t state));  
     void        attachNewFrame(void (*_fn_new_frame)(ValueList * valueslist));  
     void        attachUpdatedFrame(void (*_fn_updated_frame)(ValueList * valueslist));  
+    ValueList * addCustomValue(char * name, char * value, uint8_t * flags);
     ValueList * getList(void);
     uint8_t     valuesDump(void);
     char *      valueGet(char * name, char * value);
@@ -118,10 +120,12 @@ class TInfo
 
   private:
     uint8_t       clearBuffer();
-    ValueList *   valueAdd (char * name, char * value, uint8_t checksum, uint8_t * valuestate);
+    ValueList *   valueAdd (char * name, char * value, uint8_t checksum, uint8_t * flags);
+    boolean       valueRemove (char * name);
+    boolean       valueRemoveFlagged(uint8_t flags);
     int           labelCount();
     unsigned char calcChecksum(char *etiquette, char *valeur) ;
-    void          customLabel( char * plabel, char * pvalue) ;
+    void          customLabel( char * plabel, char * pvalue, uint8_t * pflags) ;
     ValueList *   checkLine(char * pline) ;
 
     _State_e  _state; // Teleinfo machine state