|
@@ -4,6 +4,7 @@ include "object_operations.alh"
|
|
|
include "conformance_scd.alh"
|
|
|
include "io.alh"
|
|
|
include "metamodels.alh"
|
|
|
+include "mini_modify.alh"
|
|
|
|
|
|
Boolean function main(model : Element):
|
|
|
String cmd
|
|
@@ -11,76 +12,109 @@ Boolean function main(model : Element):
|
|
|
Element schedule_init
|
|
|
Element schedule_run
|
|
|
Element schedule
|
|
|
- String conforming
|
|
|
- log("Start simulation of model!")
|
|
|
+ Float current_time
|
|
|
+
|
|
|
+ String time
|
|
|
+ time = set_pop(allInstances(model, "FullRuntime/Time"))
|
|
|
+ current_time = read_attribute(model, time, "current_time")
|
|
|
|
|
|
schedule_init = create_schedule(model)
|
|
|
schedule_run = read_root()
|
|
|
|
|
|
while (bool_not(has_input())):
|
|
|
- if (read_attribute(model, "time", "start_time") == read_attribute(model, "time", "current_time")):
|
|
|
+ if (read_attribute(model, time, "start_time") == read_attribute(model, time, "current_time")):
|
|
|
schedule = schedule_init
|
|
|
else:
|
|
|
if (element_eq(schedule_run, read_root())):
|
|
|
schedule_run = create_schedule(model)
|
|
|
schedule = schedule_run
|
|
|
- //schedule = create_schedule(model)
|
|
|
- step_simulation(model, schedule)
|
|
|
+ current_time = step_simulation(model, schedule, current_time)
|
|
|
|
|
|
log("Finishing simulation, as we got input!")
|
|
|
+ instantiate_attribute(model, time, "current_time", current_time)
|
|
|
return True!
|
|
|
|
|
|
Element function create_schedule(model : Element):
|
|
|
// Create nice graph first
|
|
|
Element nodes
|
|
|
Element successors
|
|
|
+ Element predecessors
|
|
|
String element_name
|
|
|
Element incoming_links
|
|
|
Element all_blocks
|
|
|
|
|
|
- nodes = allInstances(model, "Block")
|
|
|
- successors = create_node()
|
|
|
- while (read_nr_out(nodes) > 0):
|
|
|
+ nodes = allInstances(model, "FullRuntime/Block")
|
|
|
+ successors = dict_create()
|
|
|
+ predecessors = dict_create()
|
|
|
+ while (set_len(nodes) > 0):
|
|
|
element_name = set_pop(nodes)
|
|
|
if (bool_not(dict_in(successors, element_name))):
|
|
|
dict_add(successors, element_name, create_node())
|
|
|
+ if (bool_not(dict_in(predecessors, element_name))):
|
|
|
+ dict_add(predecessors, element_name, create_node())
|
|
|
|
|
|
- if (is_nominal_instance(model, element_name, "ICBlock")):
|
|
|
+ if (is_nominal_instance(model, element_name, "FullRuntime/ICBlock")):
|
|
|
if (element_eq(read_attribute(model, element_name, "last_in"), read_root())):
|
|
|
- incoming_links = allIncomingAssociationInstances(model, element_name, "InitialCondition")
|
|
|
+ incoming_links = allIncomingAssociationInstances(model, element_name, "FullRuntime/InitialCondition")
|
|
|
else:
|
|
|
incoming_links = create_node()
|
|
|
- if (is_nominal_instance(model, element_name, "DerivatorBlock")):
|
|
|
+ if (is_nominal_instance(model, element_name, "FullRuntime/DerivatorBlock")):
|
|
|
Element new_incoming_links
|
|
|
- new_incoming_links = allIncomingAssociationInstances(model, element_name, "Link")
|
|
|
+ new_incoming_links = allIncomingAssociationInstances(model, element_name, "FullRuntime/Link")
|
|
|
while (read_nr_out(new_incoming_links) > 0):
|
|
|
list_append(incoming_links, set_pop(new_incoming_links))
|
|
|
else:
|
|
|
- incoming_links = allIncomingAssociationInstances(model, element_name, "Link")
|
|
|
+ incoming_links = allIncomingAssociationInstances(model, element_name, "FullRuntime/Link")
|
|
|
|
|
|
- while (read_nr_out(incoming_links) > 0):
|
|
|
+ while (set_len(incoming_links) > 0):
|
|
|
String source
|
|
|
source = readAssociationSource(model, set_pop(incoming_links))
|
|
|
if (bool_not(dict_in(successors, source))):
|
|
|
dict_add(successors, source, create_node())
|
|
|
set_add(successors[source], element_name)
|
|
|
+ set_add(predecessors[element_name], source)
|
|
|
|
|
|
Element values
|
|
|
values = create_node()
|
|
|
+ dict_add(values, "model", model)
|
|
|
dict_add(values, "S", create_node())
|
|
|
dict_add(values, "index", 0)
|
|
|
dict_add(values, "indices", create_node())
|
|
|
dict_add(values, "lowlink", create_node())
|
|
|
dict_add(values, "onStack", create_node())
|
|
|
dict_add(values, "successors", successors)
|
|
|
+ dict_add(values, "predecessors", predecessors)
|
|
|
dict_add(values, "SCC", create_node())
|
|
|
|
|
|
- nodes = allInstances(model, "Block")
|
|
|
- while (read_nr_out(nodes) > 0):
|
|
|
- strongconnect(set_pop(nodes), values)
|
|
|
+ nodes = get_topolist(values)
|
|
|
+ while (list_len(nodes) > 0):
|
|
|
+ strongconnect(list_pop_final(nodes), values)
|
|
|
|
|
|
return values["SCC"]!
|
|
|
|
|
|
+Element function get_topolist(values : Element):
|
|
|
+ Element result
|
|
|
+ Element predecessors
|
|
|
+ Element remaining
|
|
|
+ String current_element
|
|
|
+ Element cur_predecessors
|
|
|
+
|
|
|
+ result = list_create()
|
|
|
+ predecessors = dict_copy(values["predecessors"])
|
|
|
+
|
|
|
+ while (dict_len(predecessors) > 0):
|
|
|
+ remaining = dict_keys(predecessors)
|
|
|
+ while (set_len(remaining) > 0):
|
|
|
+ current_element = set_pop(remaining)
|
|
|
+ cur_predecessors = predecessors[current_element]
|
|
|
+ if (set_len(set_overlap(list_to_set(result), cur_predecessors)) == set_len(cur_predecessors)):
|
|
|
+ // All predecessors of this node have already been visited
|
|
|
+ dict_delete(predecessors, current_element)
|
|
|
+ remaining = dict_keys(predecessors)
|
|
|
+ list_append(result, current_element)
|
|
|
+
|
|
|
+ return result!
|
|
|
+
|
|
|
Integer function min(a : Integer, b : Integer):
|
|
|
if (a < b):
|
|
|
return a!
|
|
@@ -101,7 +135,7 @@ Void function strongconnect(v : String, values : Element):
|
|
|
Element successors
|
|
|
String w
|
|
|
successors = values["successors"][v]
|
|
|
- while (read_nr_out(successors) > 0):
|
|
|
+ while (set_len(successors) > 0):
|
|
|
w = set_pop(successors)
|
|
|
if (bool_not(dict_in(values["indices"], w))):
|
|
|
strongconnect(w, values)
|
|
@@ -125,9 +159,6 @@ Void function strongconnect(v : String, values : Element):
|
|
|
|
|
|
return!
|
|
|
|
|
|
-String function readType(model : Element, name : String):
|
|
|
- return reverseKeyLookup(model["metamodel"]["model"], dict_read_node(model["type_mapping"], model["model"][name]))!
|
|
|
-
|
|
|
Boolean function solve_scc(model : Element, scc : Element):
|
|
|
Element m
|
|
|
Integer i
|
|
@@ -159,15 +190,15 @@ Boolean function solve_scc(model : Element, scc : Element):
|
|
|
log("Creating matrix row")
|
|
|
// First element of scc
|
|
|
block = scc[i]
|
|
|
- blocktype = readType(model, block)
|
|
|
+ blocktype = read_type(model, block)
|
|
|
|
|
|
// First write 1 in the current block
|
|
|
dict_overwrite(m[i], i, 1.0)
|
|
|
|
|
|
// Now check all blocks that are incoming
|
|
|
- if (blocktype == "AdditionBlock"):
|
|
|
+ if (blocktype == "FullRuntime/AdditionBlock"):
|
|
|
constant = 0.0
|
|
|
- elif (blocktype == "MultiplyBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/MultiplyBlock"):
|
|
|
constant = 1.0
|
|
|
|
|
|
log("Generating matrix for " + blocktype)
|
|
@@ -184,21 +215,21 @@ Boolean function solve_scc(model : Element, scc : Element):
|
|
|
if (set_in(scc, selected)):
|
|
|
// Part of the loop, so in the index of selected in scc
|
|
|
// Five options:
|
|
|
- if (blocktype == "AdditionBlock"):
|
|
|
+ if (blocktype == "FullRuntime/AdditionBlock"):
|
|
|
// 1) AdditionBlock
|
|
|
// Add the negative of this signal, which is as of yet unknown
|
|
|
// x = y + z --> x - y - z = 0
|
|
|
dict_overwrite(m[i], list_index_of(scc, selected), -1.0)
|
|
|
- elif (blocktype == "MultiplyBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/MultiplyBlock"):
|
|
|
// 2) MultiplyBlock
|
|
|
if (index_to_write_constant != -1):
|
|
|
return False!
|
|
|
index_to_write_constant = list_index_of(scc, selected)
|
|
|
- elif (blocktype == "NegatorBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/NegatorBlock"):
|
|
|
// 3) NegatorBlock
|
|
|
// Add the positive of the signal, which is as of yet unknown
|
|
|
dict_overwrite(m[i], list_index_of(scc, selected), 1.0)
|
|
|
- elif (blocktype == "DelayBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/DelayBlock"):
|
|
|
// 5) DelayBlock
|
|
|
// Just copies a single value
|
|
|
dict_overwrite(m[i], list_index_of(scc, selected), -1.0)
|
|
@@ -207,10 +238,10 @@ Boolean function solve_scc(model : Element, scc : Element):
|
|
|
return False!
|
|
|
else:
|
|
|
// A constant, which we can assume is already computed and thus usable
|
|
|
- if (blocktype == "AdditionBlock"):
|
|
|
+ if (blocktype == "FullRuntime/AdditionBlock"):
|
|
|
constant = constant + cast_float(read_attribute(model, selected, "signal"))
|
|
|
dict_overwrite(m[i], read_nr_out(scc), constant)
|
|
|
- elif (blocktype == "MultiplyBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/MultiplyBlock"):
|
|
|
constant = constant * cast_float(read_attribute(model, selected, "signal"))
|
|
|
// Not written to constant part, as multiplies a variable
|
|
|
|
|
@@ -237,7 +268,6 @@ Boolean function solve_scc(model : Element, scc : Element):
|
|
|
i = 0
|
|
|
while (i < read_nr_out(m)):
|
|
|
block = scc[i]
|
|
|
- unset_attribute(model, block, "signal")
|
|
|
instantiate_attribute(model, block, "signal", m[i][read_nr_out(scc)])
|
|
|
log((("Solved " + block) + " to ") + cast_string(m[i][read_nr_out(scc)]))
|
|
|
i = i + 1
|
|
@@ -254,8 +284,7 @@ Integer function list_index_of(lst : Element, elem : Element):
|
|
|
i = i + 1
|
|
|
return -1!
|
|
|
|
|
|
-Void function step_simulation(model : Element, schedule : Element):
|
|
|
- String time
|
|
|
+Float function step_simulation(model : Element, schedule : Element, time : Float):
|
|
|
Float signal
|
|
|
Element incoming
|
|
|
String selected
|
|
@@ -267,117 +296,102 @@ Void function step_simulation(model : Element, schedule : Element):
|
|
|
Float delta_t
|
|
|
Element scc
|
|
|
|
|
|
- time = "time"
|
|
|
delta_t = 0.1
|
|
|
|
|
|
- memory_blocks = create_node()
|
|
|
- output("SIM_TIME " + cast_string(read_attribute(model, time, "current_time")))
|
|
|
+ memory_blocks = set_create()
|
|
|
i = 0
|
|
|
- while (i < read_nr_out(schedule)):
|
|
|
+ while (i < list_len(schedule)):
|
|
|
scc = list_read(schedule, i)
|
|
|
i = i + 1
|
|
|
|
|
|
if (list_len(scc) > 1):
|
|
|
- log("Solving algebraic loop!")
|
|
|
if (bool_not(solve_scc(model, scc))):
|
|
|
output("ALGEBRAIC_LOOP")
|
|
|
- return !
|
|
|
+ return time!
|
|
|
else:
|
|
|
- block = set_pop(scc)
|
|
|
+ block = list_read(scc, 0)
|
|
|
|
|
|
// Execute "block"
|
|
|
- blocktype = readType(model, block)
|
|
|
- if (blocktype == "ConstantBlock"):
|
|
|
+ blocktype = read_type(model, block)
|
|
|
+ if (blocktype == "FullRuntime/ConstantBlock"):
|
|
|
signal = read_attribute(model, block, "value")
|
|
|
- elif (blocktype == "AdditionBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/AdditionBlock"):
|
|
|
signal = 0.0
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = signal + cast_float(read_attribute(model, selected, "signal"))
|
|
|
- elif (blocktype == "MultiplyBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/MultiplyBlock"):
|
|
|
signal = 1.0
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = signal * cast_float(read_attribute(model, selected, "signal"))
|
|
|
- elif (blocktype == "NegatorBlock"):
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
+ elif (blocktype == "FullRuntime/NegatorBlock"):
|
|
|
signal = 0.0
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = float_neg(cast_float(read_attribute(model, selected, "signal")))
|
|
|
- elif (blocktype == "InverseBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/InverseBlock"):
|
|
|
signal = 0.0
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = float_division(1.0, cast_float(read_attribute(model, selected, "signal")))
|
|
|
- elif (blocktype == "DelayBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/DelayBlock"):
|
|
|
signal = 0.0
|
|
|
if (element_eq(read_attribute(model, block, "last_in"), read_root())):
|
|
|
// No memory yet, so use initial condition
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "InitialCondition")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/InitialCondition")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = cast_float(read_attribute(model, selected, "signal"))
|
|
|
else:
|
|
|
signal = read_attribute(model, block, "last_in")
|
|
|
- unset_attribute(model, block, "last_in")
|
|
|
set_add(memory_blocks, block)
|
|
|
- elif (blocktype == "IntegratorBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/IntegratorBlock"):
|
|
|
if (element_eq(read_attribute(model, block, "last_in"), read_root())):
|
|
|
// No history yet, so use initial values
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "InitialCondition")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/InitialCondition")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = cast_float(read_attribute(model, selected, "signal"))
|
|
|
else:
|
|
|
- signal = cast_float(read_attribute(model, block, "last_in")) + (delta_t * cast_float(read_attribute(model, block, "last_out")))
|
|
|
- unset_attribute(model, block, "last_in")
|
|
|
- unset_attribute(model, block, "last_out")
|
|
|
+ signal = cast_float(read_attribute(model, block, "last_out")) + (delta_t * cast_float(read_attribute(model, block, "last_in")))
|
|
|
instantiate_attribute(model, block, "last_out", signal)
|
|
|
set_add(memory_blocks, block)
|
|
|
- elif (blocktype == "DerivatorBlock"):
|
|
|
+ elif (blocktype == "FullRuntime/DerivatorBlock"):
|
|
|
if (element_eq(read_attribute(model, block, "last_in"), read_root())):
|
|
|
// No history yet, so use initial values
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "InitialCondition")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/InitialCondition")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = cast_float(read_attribute(model, selected, "signal"))
|
|
|
else:
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ selected = set_pop(incoming)
|
|
|
signal = (cast_float(read_attribute(model, selected, "signal")) - cast_float(read_attribute(model, block, "last_in"))) / delta_t
|
|
|
- unset_attribute(model, block, "last_in")
|
|
|
set_add(memory_blocks, block)
|
|
|
- elif (blocktype == "ProbeBlock"):
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
- selected = readAssociationSource(model, set_pop(incoming))
|
|
|
- signal = cast_float(read_attribute(model, selected, "signal"))
|
|
|
- output((("SIM_PROBE " + cast_string(read_attribute(model, block, "name"))) + " ") + cast_string(signal))
|
|
|
-
|
|
|
- unset_attribute(model, block, "signal")
|
|
|
+ elif (blocktype == "FullRuntime/ProbeBlock"):
|
|
|
+ incoming = allAssociationOrigins(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
+ signal = cast_float(read_attribute(model, set_pop(incoming), "signal"))
|
|
|
+ output(cast_string(time) + " " + cast_string(read_attribute(model, block, "name")) + " " + cast_string(signal))
|
|
|
+
|
|
|
instantiate_attribute(model, block, "signal", signal)
|
|
|
- output("SIM_END")
|
|
|
|
|
|
- while (read_nr_out(memory_blocks) > 0):
|
|
|
+ while (set_len(memory_blocks) > 0):
|
|
|
block = set_pop(memory_blocks)
|
|
|
// Update memory
|
|
|
- incoming = allIncomingAssociationInstances(model, block, "Link")
|
|
|
- while (read_nr_out(incoming) > 0):
|
|
|
+ incoming = allIncomingAssociationInstances(model, block, "FullRuntime/Link")
|
|
|
+ while (set_len(incoming) > 0):
|
|
|
selected = readAssociationSource(model, set_pop(incoming))
|
|
|
instantiate_attribute(model, block, "last_in", cast_float(read_attribute(model, selected, "signal")))
|
|
|
|
|
|
// Increase simulation time
|
|
|
- Float new_time
|
|
|
- new_time = cast_float(read_attribute(model, time, "current_time")) + delta_t
|
|
|
- unset_attribute(model, time, "current_time")
|
|
|
- instantiate_attribute(model, time, "current_time", new_time)
|
|
|
-
|
|
|
- return !
|
|
|
+ return time + delta_t!
|
|
|
|
|
|
Void function eliminateGaussJordan(m : Element):
|
|
|
Integer i
|