diff -r e8b99f896416 -r 38754701ac41 stage4/generate_cc/generate_cc_sfc.cc
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/stage4/generate_cc/generate_cc_sfc.cc	Fri Feb 23 19:19:23 2007 +0100
@@ -0,0 +1,567 @@
+/*
+ * (c) 2007 Mario de Sousa, Laurent Bessard
+ *
+ * Offered to the public under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2 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.
+ *
+ * This code is made available on the understanding that it will not be
+ * used in safety-critical situations without a full and competent review.
+ */
+
+/*
+ * An IEC 61131-3 IL and ST compiler.
+ *
+ * Based on the
+ * FINAL DRAFT - IEC 61131-3, 2nd Ed. (2001-12-10)
+ *
+ */
+
+
+/*
+ * Conversion of sfc networks (i.e. SFC code).
+ *
+ * This is part of the 4th stage that generates
+ * a c++ source program equivalent to the SFC, IL and ST
+ * code.
+ */
+
+
+
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+
+class generate_cc_sfc_transitiontest_c: public generate_cc_base_c {
+  
+  private:
+    generate_cc_il_c *generate_cc_il;
+    generate_cc_st_c *generate_cc_st;
+    
+  public:
+    generate_cc_sfc_transitiontest_c(stage4out_c *s4o_ptr, symbol_c *scope, const char *variable_prefix = NULL)
+    : generate_cc_base_c(s4o_ptr) {
+      generate_cc_il = new generate_cc_il_c(s4o_ptr, scope, variable_prefix);
+      generate_cc_st = new generate_cc_st_c(s4o_ptr, scope, variable_prefix);
+      this->set_variable_prefix(variable_prefix);
+    }
+    
+    ~generate_cc_sfc_transitiontest_c(void) {
+      delete generate_cc_il;
+      delete generate_cc_st;
+    }
+
+    void print_step_argument(symbol_c *step_name, const char* argument) {
+      print_variable_prefix();
+      s4o.print("step_list[");
+      step_name->accept(*this);
+      s4o.print("].");
+      s4o.print(argument);
+    }
+    
+    void print_reset_step(symbol_c *step_name) {
+      s4o.print(s4o.indent_spaces);
+      print_step_argument(step_name, "state");
+      s4o.print(" = 0;\n" + s4o.indent_spaces + "if (");
+      print_step_argument(step_name, "pulse");
+      s4o.print(" != 1 {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_step_argument(step_name, "pulse");
+      s4o.print(" = 2;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n" + s4o.indent_spaces + "else {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_step_argument(step_name, "pulse");
+      s4o.print(" = 0;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n" + s4o.indent_spaces);
+      print_step_argument(step_name, "elapsed_time");
+      s4o.print(" = __time_to_timespec(1, 0, 0, 0, 0, 0);");
+    }
+    
+    void print_set_step(symbol_c *step_name) {
+      s4o.print(s4o.indent_spaces);
+      print_step_argument(step_name, "state");
+      s4o.print(" = 1;\n" + s4o.indent_spaces);
+      print_step_argument(step_name, "pulse");
+      s4o.print(" = 1;");
+    } 
+    
+    void print_steps_state_test(steps_c *symbol) {
+      if (symbol->step_name != NULL) {
+        print_step_argument(symbol->step_name, "state");
+      }
+      if (symbol->step_name_list != NULL) {
+        for(int i = 0; i < ((list_c*)symbol->step_name_list)->n; i++) {
+          print_step_argument(((list_c*)symbol->step_name_list)->elements[i], "state");
+          if (i < ((list_c*)symbol->step_name_list)->n - 1) {
+            s4o.print(" && ");
+          }
+        }
+      }
+    }
+      
+    void print_reset_steps(steps_c *symbol) {
+      if (symbol->step_name != NULL) {
+        print_reset_step(symbol->step_name);
+        s4o.print("\n");
+      }
+      if (symbol->step_name_list != NULL) {
+        for(int i = 0; i < ((list_c*)symbol->step_name_list)->n; i++) {
+          print_reset_step(((list_c*)symbol->step_name_list)->elements[i]);
+          s4o.print("\n");
+        }
+      }
+    }
+
+    void print_set_steps(steps_c *symbol) {
+      if (symbol->step_name != NULL) {
+        print_set_step(symbol->step_name);
+        s4o.print("\n");
+      }
+      if (symbol->step_name_list != NULL) {
+        for(int i = 0; i < ((list_c*)symbol->step_name_list)->n; i++) {
+          print_set_step(((list_c*)symbol->step_name_list)->elements[i]);
+          s4o.print("\n");
+        }
+      }
+    }
+
+/*********************************************/
+/* B.1.6  Sequential function chart elements */
+/*********************************************/
+    
+    void *visit(initial_step_c *symbol) {return NULL;}
+    
+    void *visit(step_c *symbol) {return NULL;}
+
+    void *visit(transition_c *symbol) {
+      s4o.print(s4o.indent_spaces + "if (");
+      print_steps_state_test((steps_c *)symbol->from_steps);
+      s4o.print(") {\n");
+      s4o.indent_right();
+      
+      // Calculate transition value
+      if (symbol->transition_condition_il != NULL) {
+        generate_cc_il->declare_backup_variable();
+        s4o.print(s4o.indent_spaces);
+        symbol->transition_condition_il->accept(*generate_cc_il);
+        s4o.print("if (");
+        generate_cc_il->print_backup_variable();
+        s4o.print(") {\n");
+      }
+      if (symbol->transition_condition_st != NULL) {
+        s4o.print(s4o.indent_spaces + "if (");
+        symbol->transition_condition_st->accept(*generate_cc_st);
+        s4o.print(") {\n");
+      }
+      
+      s4o.indent_right();      
+      print_reset_steps((steps_c *)symbol->from_steps);
+      print_set_steps((steps_c *)symbol->to_steps);      
+      s4o.indent_left();
+
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n\n");
+      return NULL;
+    }
+    
+    void *visit(action_c *symbol) {return NULL;}
+
+}; /* generate_cc_sfc_transitiontest_c */
+
+
+
+
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+
+class generate_cc_sfc_stepassociation_c: public generate_cc_base_c {
+  
+  private:
+    symbol_c *current_step;
+    symbol_c *current_action;
+  
+  public:
+    generate_cc_sfc_stepassociation_c(stage4out_c *s4o_ptr, symbol_c *scope, const char *variable_prefix = NULL)
+    : generate_cc_base_c(s4o_ptr) {
+      this->set_variable_prefix(variable_prefix);
+    }
+
+    void print_step_argument(symbol_c *step_name, const char* argument) {
+      print_variable_prefix();
+      s4o.print("step_list[");
+      step_name->accept(*this);
+      s4o.print("].");
+      s4o.print(argument);
+    }
+
+    void print_action_argument(symbol_c *action_name, const char* argument) {
+      print_variable_prefix();
+      s4o.print("action_list[");
+      action_name->accept(*this);
+      s4o.print("].");
+      s4o.print(argument);
+    }
+
+/*********************************************/
+/* B.1.6  Sequential function chart elements */
+/*********************************************/
+    
+    void *visit(initial_step_c *symbol) {
+      s4o.print(s4o.indent_spaces + "// ");
+      symbol->step_name->accept(*this);
+      s4o.print(" action associations\n");
+      current_step = symbol->step_name;
+      symbol->action_association_list->accept(*this);
+      return NULL;
+    }
+    
+    void *visit(step_c *symbol) {
+      s4o.print(s4o.indent_spaces + "// ");
+      symbol->step_name->accept(*this);
+      s4o.print(" action associations\n");
+      current_step = symbol->step_name;
+      symbol->action_association_list->accept(*this);
+      return NULL;
+    }
+
+    void *visit(transition_c *symbol) {return NULL;}
+    
+    void *visit(action_c *symbol) {return NULL;}
+
+    void *visit(action_association_list_c* symbol) {
+      print_list(symbol, "", "\n", "\n\n");
+      return NULL;
+    }
+
+    void *visit(action_association_c *symbol) {
+      if (symbol->action_qualifier != NULL) {
+        current_action = symbol->action_name;
+        symbol->action_qualifier->accept(*this);
+      }
+      else {
+        s4o.print(s4o.indent_spaces + "if (");
+        print_step_argument(current_step, "state");
+        s4o.print(") {\n");
+        s4o.indent_right();
+        s4o.print(s4o.indent_spaces);
+        print_action_argument(symbol->action_name, "state");
+        s4o.print(" = 1;\n");
+        s4o.indent_left();
+        s4o.print(s4o.indent_spaces + "}");
+      }
+      return NULL;
+    }
+
+    void *visit(action_qualifier_c *symbol) {
+      char *qualifier = (char *)symbol->action_qualifier->accept(*this);
+      
+      s4o.print(s4o.indent_spaces + "if (");
+      if (strcmp(qualifier, "N") == 0) {
+        print_step_argument(current_step, "state");
+      }
+      if (strcmp(qualifier, "P") == 0 || strcmp(qualifier, "SD") == 0 || 
+          strcmp(qualifier, "DS") == 0 || strcmp(qualifier, "SL") == 0) {
+        print_step_argument(current_step, "pulse");
+        s4o.print(" == 1");
+      }
+      if (strcmp(qualifier, "D") == 0 || strcmp(qualifier, "L") == 0) {
+        print_step_argument(current_step, "state");
+        s4o.print(" && ");
+        print_step_argument(current_step, "elapsed_time");
+        if (strcmp(qualifier, "D") == 0) {
+          s4o.print(" >= ");
+        }
+        else {
+          s4o.print(" < ");
+        }
+        symbol->action_time->accept(*this);  
+      }
+      s4o.print(") {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      if (strcmp(qualifier, "N") == 0 || strcmp(qualifier, "P") == 0 ||
+          strcmp(qualifier, "D") == 0 || strcmp(qualifier, "L") == 0) {
+        print_action_argument(current_action, "state");
+        s4o.print(" = 1;\n");  
+      }
+      if (strcmp(qualifier, "SD") == 0 || strcmp(qualifier, "DS") == 0 || 
+          strcmp(qualifier, "SL") == 0) {
+        if (strcmp(qualifier, "SL") == 0) {
+          print_action_argument(current_action, "reset_remaining_time");  
+        }
+        else {
+          print_action_argument(current_action, "set_remaining_time");
+        }
+        s4o.print(" = ");
+        symbol->action_time->accept(*this);
+        s4o.print(";\n");
+      }
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}");
+      if (strcmp(qualifier, "DS") == 0) {
+        print_step_argument(current_step, "pulse");
+        s4o.print(" == 2) {\n");
+        s4o.indent_right();
+        s4o.print(s4o.indent_spaces);
+        print_action_argument(current_action, "set_remaining_time");
+        s4o.print(" = __time_to_timespec(1, 0, 0, 0, 0, 0);\n");
+      }
+      return NULL;
+    }
+
+    void *visit(qualifier_c *symbol) {
+      return (void *)symbol->value;
+    }
+
+    void *visit(timed_qualifier_c *symbol) {
+      return (void *)symbol->value;
+    }
+
+}; /* generate_cc_sfc_actiondecl_c */
+
+
+
+
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+
+class generate_cc_sfc_actionexecution_c: public generate_cc_base_c {
+  
+  private:
+    generate_cc_SFC_IL_ST_c *generate_cc_code;
+    
+  public:
+    generate_cc_sfc_actionexecution_c(stage4out_c *s4o_ptr, symbol_c *scope, const char *variable_prefix = NULL)
+    : generate_cc_base_c(s4o_ptr) {
+      generate_cc_code = new generate_cc_SFC_IL_ST_c(s4o_ptr, scope, variable_prefix);
+      this->set_variable_prefix(variable_prefix);
+    }
+    
+    ~generate_cc_sfc_actionexecution_c(void) {
+      delete generate_cc_code;
+    }
+
+/*********************************************/
+/* B.1.6  Sequential function chart elements */
+/*********************************************/
+    
+    void *visit(initial_step_c *symbol) {return NULL;}
+    
+    void *visit(step_c *symbol) {return NULL;}
+
+    void *visit(transition_c *symbol) {return NULL;}
+    
+    void *visit(action_c *symbol) {
+      s4o.print(s4o.indent_spaces + "if(");
+      print_variable_prefix();
+      s4o.print("action_list[");
+      symbol->action_name->accept(*this);
+      s4o.print("].state) {");
+      s4o.indent_right();
+      
+      // generate action code
+      symbol->function_block_body->accept(*generate_cc_code);
+      
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n\n");
+      return NULL;
+    }
+
+}; /* generate_cc_sfc_actiondecl_c */
+ 
+ 
+ 
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+/***********************************************************************/
+
+class generate_cc_sfc_c: public generate_cc_typedecl_c {
+  
+  private:
+    generate_cc_sfc_transitiontest_c *generate_cc_sfc_transitiontest;
+    generate_cc_sfc_stepassociation_c *generate_cc_sfc_stepassociation;
+    generate_cc_sfc_actionexecution_c *generate_cc_sfc_actionexecution;
+  
+  public:
+    generate_cc_sfc_c(stage4out_c *s4o_ptr, symbol_c *scope, const char *variable_prefix = NULL)
+    : generate_cc_typedecl_c(s4o_ptr) {
+      generate_cc_sfc_transitiontest = new generate_cc_sfc_transitiontest_c(s4o_ptr, scope, variable_prefix);
+      generate_cc_sfc_stepassociation = new generate_cc_sfc_stepassociation_c(s4o_ptr, scope, variable_prefix);
+      generate_cc_sfc_actionexecution = new generate_cc_sfc_actionexecution_c(s4o_ptr, scope, variable_prefix);
+      this->set_variable_prefix(variable_prefix);
+    }
+  
+    virtual ~generate_cc_sfc_c(void) {
+      delete generate_cc_sfc_transitiontest;
+      delete generate_cc_sfc_stepassociation;
+      delete generate_cc_sfc_actionexecution;
+    }
+
+/*********************************************/
+/* B.1.6  Sequential function chart elements */
+/*********************************************/
+
+    void *visit(sfc_network_c *symbol) {
+      s4o.print(s4o.indent_spaces +"INT i;\n\n");
+      s4o.print(s4o.indent_spaces +"BOOL transition;\n\n");
+            
+      /* generate step initilizations */
+      s4o.print(s4o.indent_spaces + "// Steps initialisation\n");
+      s4o.print(s4o.indent_spaces + "for (i = 0; i < ");
+      print_variable_prefix();
+      s4o.print("nb_steps; i++) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("step_list[i].pulse = 0;\n");
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("step_list[i].state) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("step_list[i].elapsed_time = __add_timespec(");
+      print_variable_prefix();
+      s4o.print("step_list[i].elapsed_time, PERIOD);\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+
+      /* generate action initilizations */
+      s4o.print(s4o.indent_spaces + "// Actions initialisation\n");
+      s4o.print(s4o.indent_spaces + "for (i = 0; i < ");
+      print_variable_prefix();
+      s4o.print("nb_actions; i++) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].state = 0;\n");
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].set = 0;\n");
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].reset = 0;\n");
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("__compare_timespec(>, action_list[i].set_remaining_time, __time_to_timespec(1, 0, 0, 0, 0, 0)) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].set_remaining_time = __sub_timespec(");
+      print_variable_prefix();
+      s4o.print("action_list[i].set_remaining_time, PERIOD);\n");
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("__compare_timespec(<=, action_list[i].set_remaining_time, __time_to_timespec(1, 0, 0, 0, 0, 0)) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].set_remaining_time = __time_to_timespec(1, 0, 0, 0, 0, 0);\n");
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].set = 1;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("__compare_timespec(>, action_list[i].reset_remaining_time, __time_to_timespec(1, 0, 0, 0, 0, 0)) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].reset_remaining_time = __sub_timespec(");
+      print_variable_prefix();
+      s4o.print("action_list[i].reset_remaining_time, PERIOD);\n");
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("__compare_timespec(<=, action_list[i].reset_remaining_time, __time_to_timespec(1, 0, 0, 0, 0, 0)) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].reset_remaining_time = __time_to_timespec(1, 0, 0, 0, 0, 0);\n");
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].reset = 1;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n\n");
+      
+      /* generate transition tests */
+      s4o.print(s4o.indent_spaces + "// Transitions fire test\n");
+      symbol->accept(*generate_cc_sfc_transitiontest);
+      s4o.print("\n");
+      
+       /* generate step association */
+      s4o.print(s4o.indent_spaces + "// Steps association\n");
+      symbol->accept(*generate_cc_sfc_stepassociation);
+      s4o.print("\n");
+      
+      /* generate action state evaluation */
+      s4o.print(s4o.indent_spaces + "// Actions state evaluation\n");
+      s4o.print(s4o.indent_spaces + "for (i = 0; i < ");
+      print_variable_prefix();
+      s4o.print("nb_actions; i++) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("action_list[i].set) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].stored = 1;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n" + s4o.indent_spaces + "if (");
+      print_variable_prefix();
+      s4o.print("action_list[i].set) {\n");
+      s4o.indent_right();
+      s4o.print(s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].set_remaining_time = 0;\n" + s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].reset_remaining_time = 0;\n" + s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].stored = 0;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n" + s4o.indent_spaces);
+      print_variable_prefix();
+      s4o.print("action_list[i].state |= ");
+      print_variable_prefix();
+      s4o.print("action_list[i].stored;\n");
+      s4o.indent_left();
+      s4o.print(s4o.indent_spaces + "}\n\n");
+      
+      /* generate action execution */
+      s4o.print(s4o.indent_spaces + "// Actions execution\n");
+      symbol->accept(*generate_cc_sfc_actionexecution);
+      s4o.print("\n");
+      
+      return NULL;
+    }
+
+    void generate(sequential_function_chart_c *sfc) {
+      sfc->accept(*this);
+    }
+
+}; /* generate_cc_sfc_c */