modelverse/models/SCCD_execute.alc

include "primitives.alh"
include "modelling.alh"
include "object_operations.alh"
include "utils.alh"
include "random.alh"
include "library.alh"

Void function print_states(model : Element, data : Element):
	Element classes
	Element states
	Element class
	String state

	log("Current states:")
	classes = set_copy(data["classes"])
	while (read_nr_out(classes) > 0):
		class = set_pop(classes)
		log(string_join(string_join(string_join("  ", class["ID"]), " : "), read_attribute(model, class["type"], "name")))
		log("	Attributes: " + dict_to_string(class["attributes"]))

		states = set_copy(class["states"])
		log("	States:")
		while (read_nr_out(states) > 0):
			state = set_pop(states)
			log(string_join("		", read_attribute(model, state, "name")))

	return!

Element function filter(model : Element, set : Element, attribute_name : String, attribute_value : Element):
	Element keys
	String key
	Element result

	result = create_node()
	while (read_nr_out(set) > 0):
		key = set_pop(set)
		if (value_eq(read_attribute(model, key, attribute_name), attribute_value)):
			set_add(result, key)

	return result!

Element function filter_exists(model : Element, set : Element, attribute_name : String):
	Element keys
	String key
	Element result

	result = create_node()
	while (read_nr_out(set) > 0):
		key = set_pop(set)
		if (element_neq(read_attribute(model, key, attribute_name), read_root())):
			set_add(result, key)

	return result!

Element function expand_current_state(model : Element, state : String, class_data : Element):
	// Find the hierarchy of all current states, and select those that contain the currently selected state
	Element result
	Element current_states
	result = create_node()
	current_states = set_copy(class_data["states"])

	Element hierarchy
	String deep_state
	while (read_nr_out(current_states) > 0):
		deep_state = set_pop(current_states)
		hierarchy = find_hierarchy(model, deep_state)
		// Got the hierarchy of one of the states

		if (set_in(hierarchy, state)):
			// This hierarchy contains the root state we are checking for, so add to set
			set_add(result, deep_state)

	return result!

Element function expand_initial_state(model : Element, state : String, class_data : Element):
	String t
	t = read_type(model, state)
	if (t == "SCCD/CompositeState"):
		// Recurse further in the composite
		return expand_composite_state(model, state, class_data)!
	elif (t == "SCCD/ParallelState"):
		// Split up all components
		return expand_parallel_state(model, state, class_data)!
	elif (t == "SCCD/HistoryState"):
		// Reset the history
		// This is not really an initial state, but it is called in exactly the same places
		return class_data["history"][state]!
	else:
		// Probably just an atomic, so return this one only
		Element result
		result = create_node()
		set_add(result, state)
		return result!

Element function expand_composite_state(model : Element, composite_state : String, class_data : Element):
	// Resolve all initial states from a single composite state
	String initial

	// Fetch the initial state
	initial = set_pop(filter(model, allAssociationDestinations(model, composite_state, "SCCD/composite_children"), "isInitial", True))

	// Expand the initial state, depending on what it is
	return expand_initial_state(model, initial, class_data)!

Element function expand_parallel_state(model : Element, parallel_state : String, class_data : Element):
	// Resolve all initial states from a single parallel state
	Element children
	Element result
	Element expanded_children

	children = allAssociationDestinations(model, parallel_state, "SCCD/parallel_children")
	result = create_node()

	while (read_nr_out(children) > 0):
		set_merge(result, expand_initial_state(model, set_pop(children), class_data))

	return result!

Void function delete_class(model : Element, data : Element, identifier : String):
	// Stop a specific class instance, with attached statechart, from executing
	dict_delete(data["classes"], identifier)

Void function start_class(model : Element, data : Element, class : String, identifier : String, parameters : Element):
	// Start up the class and assign its initial state to it

	// Create the data structure for a running class
	Element class_handle
	class_handle = create_node()
	dict_add(class_handle, "type", class)
	dict_add(class_handle, "ID", identifier)
	dict_add(class_handle, "timers", create_node())

	// Add the current state of the class
	String initial_state
	// Should only be one behaviour linked to it!
	initial_state = set_pop(allAssociationDestinations(model, class, "SCCD/behaviour"))
	dict_add(class_handle, "states", expand_initial_state(model, initial_state, class_handle))

	// Initialize history for all composite states
	Element history
	Element cstates
	String cstate

	history = create_node()
	dict_add(class_handle, "history", history)
	cstates = allInstances(model, "SCCD/CompositeState")
	while (read_nr_out(cstates) > 0):
		cstate = set_pop(cstates)
		dict_add(history, cstate, expand_initial_state(model, cstate, class_handle))

	// Add all attributes
	Element attributes
	attributes = create_node()
	Element attrs
	attrs = allAssociationDestinations(model, class, "SCCD/class_attributes")
	while (read_nr_out(attrs) > 0):
		dict_add(attributes, read_attribute(model, set_pop(attrs), "name"), read_root())
	dict_add(class_handle, "attributes", attributes)

	// Invoke constructor
	Element constructor
	constructor = read_attribute(model, class, "constructor_body")
	if (element_neq(constructor, read_root())):
		// Constructor, so execute
		constructor = get_func_AL_model(import_node(constructor))
		constructor(attributes, parameters)

	// Execute all entry actions
	Element init
	init = create_node()
	set_add(init, "")
	// Initial state before initialization is the set with an empty hierarchy
	// Empty set would not find any difference between the source and target
	execute_actions(model, init, set_copy(class_handle["states"]), attributes, data, "")

	dict_add(data["classes"], class_handle["ID"], class_handle)

	return!

Element function get_enabled_transitions(model : Element, state : String, data : Element, class : String):
	// Returns all enabled transitions
	Element result
	Element to_filter
	String attr
	String transition
	Element cond
	String evt_name
	Element evt
	Element events
	Element event_names
	Element event_parameters

	result = create_node()
	to_filter = allOutgoingAssociationInstances(model, state, "SCCD/transition")

	event_names = create_node()
	event_parameters = create_node()
	events = set_copy(data["events"])
	while (read_nr_out(events) > 0):
		evt = set_pop(events)
		evt_name = list_read(evt, 0)

		if (bool_not(set_in(event_names, evt_name))):
			// Not yet registered the event
			set_add(event_names, evt_name)
			dict_add(event_parameters, evt_name, create_node())
		// Add event parameters
		set_add(event_parameters[evt_name], list_read(evt, 1))

	while (read_nr_out(to_filter) > 0):
		transition = set_pop(to_filter)

		// Check event
		attr = read_attribute(model, transition, "event")
		if (bool_not(bool_or(element_eq(attr, read_root()), set_in(event_names, attr)))):
			// At least one enabled event is found
			continue!

		// Check after
		// Only an after if there was no event!
		if (bool_and(element_eq(attr, read_root()), read_attribute(model, transition, "after"))):
			if (dict_in(data["classes"][class]["timers"], transition)):
				// Registered timer already, let's check if it has expired
				if (float_gt(data["classes"][class]["timers"][transition], time())):
					// Not enabled yet
					continue!
			else:
				// Not registered even, so not enabled either
				continue!

		// Check condition, but depends on whether there was an event or not
		cond = read_attribute(model, transition, "cond")
		if (element_neq(cond, read_root())):
			// Got a condition, so resolve
			cond = get_func_AL_model(import_node(cond))

		if (element_neq(attr, read_root())):
			// We have an event to take into account!
			Element params
			Element param
			params = set_copy(event_parameters[attr])
			while (read_nr_out(params) > 0):
				param = set_pop(params)
				if (element_neq(cond, read_root())):
					// Got a condition to check first
					if (bool_not(cond(data["classes"][class]["attributes"], param))):
						// Condition failed, so skip
						continue!
				// Fine to add this one with the specified parameters
				set_add(result, create_tuple(transition, param))
		else:
			// No event to think about, just add the transition
			if (element_neq(cond, read_root())):
				// Check the condition first
				if (bool_not(cond(data["classes"][class]["attributes"], read_root()))):
					// Condition false, so skip
					continue!
			// Fine to add this one without event parameters (no event)
			set_add(result, create_tuple(transition, read_root()))

	return result!

Void function process_raised_event(model : Element, event : Element, parameter_action : Element, data : Element):
	String scope
	scope = read_attribute(model, event, "scope")
	if (scope == "cd"):
		// Is an event for us internally, so don't append
		// Instead, we process it directly
		String operation
		operation = read_attribute(model, event, "event")
		if (operation == "create_instance"):
			// Start up a new class of the desired type

			// Parameters of this call:
			// class -- type of the class to instantiate
			// identifier -- name of this instance, for future reference
			// parameters -- parameters for constructor
			String class
			String identifier
			Element parameters
			class = set_pop(filter(model, allInstances(model, "SCCD/Class"), "name", list_read(parameter_action, 0)))
			identifier = list_read(parameter_action, 1)
			parameters = list_read(parameter_action, 2)
			start_class(model, data, class, identifier, parameters)

		elif (operation == "delete_instance"):
			// Delete the requested class
			String identifier
			identifier = list_read(parameter_action, 0)
			delete_class(model, data, identifier)
	else:
		set_add(data["events"], create_tuple(read_attribute(model, event, "event"), parameter_action))

	return !

Element function execute_transition(model : Element, data : Element, class : String, transition_tuple : Element):
	// Execute the script (if any)
	Element script
	String transition
	Element event_parameter
	transition = list_read(transition_tuple, 0)
	event_parameter = list_read(transition_tuple, 1)

	script = read_attribute(model, transition, "script")
	if (element_neq(script, read_root())):
		script = get_func_AL_model(import_node(script))
		script(data["classes"][class]["attributes"], event_parameter)

	// Raise events (if any)
	Element events
	String event
	events = allAssociationDestinations(model, transition, "SCCD/transition_raises")
	while (read_nr_out(events) > 0):
		event = set_pop(events)

		Element parameter_action
		parameter_action = read_attribute(model, event, "parameter")
		if (element_neq(parameter_action, read_root())):
			// Got a parameter to evaluate
			parameter_action = get_func_AL_model(import_node(parameter_action))
			parameter_action = parameter_action(data["classes"][class]["attributes"], event_parameter)

		process_raised_event(model, event, parameter_action, data)

	// Find new set of states
	Element target_states
	Element source_states
	source_states = expand_current_state(model, readAssociationSource(model, transition), data["classes"][class])
	target_states = expand_initial_state(model, readAssociationDestination(model, transition), data["classes"][class])

	execute_actions(model, source_states, target_states, data["classes"][class], data, readAssociationSource(model, transition))

	return target_states!

Boolean function step_class(model : Element, data : Element, class : String):
	// Find enabled transitions in a class and execute it, updating the state
	// Iterate over all current states, searching for enabled transitions
	// Search for enabled transitions in higher levels as well!
	Element states
	Element new_states
	String state
	Element transitions
	String transition
	Boolean transitioned
	Element hierarchy
	String current_state
	Boolean found

	states = set_copy(data["classes"][class]["states"])
	new_states = create_node()
	transitioned = False

	while (read_nr_out(states) > 0):
		state = set_pop(states)
		found = False

		// Loop over the hierarchy of this state and try to apply transitions
		hierarchy = find_hierarchy(model, state)
		while (read_nr_out(hierarchy) > 0):
			current_state = list_pop(hierarchy, 0)
			transitions = get_enabled_transitions(model, current_state, data, class)

			if (read_nr_out(transitions) > 0):
				// Found an enabled transition, so store that one
				transition = random_choice(transitions)
				log("Execute enabled transition: " + cast_v2s(read_attribute(model, list_read(transition, 0), "name")))
				
				// Execute transition
				set_merge(new_states, execute_transition(model, data, class, transition))

				// When leaving an orthogonal component, we must also pop all related states that might be processed in the future!
				Element leaving
				leaving = expand_current_state(model, current_state, data["classes"][class])
				set_difference(states, leaving)

				transitioned = True
				found = True
				break!

		if (bool_not(found)):
			// Nothing found, so stay in the current state
			set_add(new_states, state)
			
	// Update states
	dict_overwrite(data["classes"][class], "states", new_states)
	//reschedule_timeouts(model, data, class)

	return transitioned!

Void function reschedule_timeouts(model : Element, data : Element, class : String):
	Element timed_transitions
	Element old_timed_transitions
	String transition
	Element states
	String state

	timed_transitions = create_node()
	states = set_copy(data["classes"][class]["states"])
	log("Rescheduling timeouts")

	// Collect all timed transitions that are currently active
	while (read_nr_out(states) > 0):
		state = set_pop(states)

		// NOTE this set_merge does not eliminate duplicates, though this should happen later on when adding the timer (see other NOTE)
		set_merge(timed_transitions, filter_exists(model, allOutgoingAssociationInstances(model, state, "SCCD/transition"), "after"))

	// Remove timers that no longer exist
	old_timed_transitions = dict_keys(data["classes"][class]["timers"])

	log("Got timed transitions: " + set_to_string(timed_transitions))
	log("Got currently scheduled transitions: " + set_to_string(old_timed_transitions))

	while (read_nr_out(old_timed_transitions) > 0):
		transition = set_pop(old_timed_transitions)
		log("Check remove " + cast_v2s(transition))

		if (bool_not(set_in(timed_transitions, transition))):
			// Transition is no longer scheduled for any state, so remove
			dict_delete(data["classes"][class]["timers"], transition)
			log("Remove timer for transition " + cast_v2s(read_attribute(model, transition, "name")))

	// Schedule timers that are not already scheduled
	while (read_nr_out(timed_transitions) > 0):
		transition = set_pop(timed_transitions)
		log("Check add " + cast_v2s(transition))

		// NOTE Normally, a timer will not be added twice here, as the previous occurence will already find it
		if (bool_not(dict_in(data["classes"][class]["timers"], transition))):
			// Not yet scheduled this transition: do so now
			Element after
			Float after_duration

			after = read_attribute(model, transition, "after")
			after = get_func_AL_model(import_node(after))
			after_duration = after(data["classes"][class]["attributes"])

			dict_add(data["classes"][class]["timers"], transition, float_addition(data["start_time"], after_duration))
			log("Add timer for transition " + cast_v2s(read_attribute(model, transition, "name")))
	log("All done!")

	return !

String function get_parent(model : Element, state : String):
	Element tmp_set
	tmp_set = allAssociationOrigins(model, state, "SCCD/composite_children")
	set_merge(tmp_set, allAssociationOrigins(model, state, "SCCD/parallel_children"))
	if (read_nr_out(tmp_set) > 0):
		return set_pop(tmp_set)!
	else:
		return ""!

Element function find_hierarchy(model : Element, state : String):
	if (state == ""):
		return create_node()!
	else:
		Element result
		String parent

		parent = get_parent(model, state)
		// We have a parent, so take the parent list first
		result = find_hierarchy(model, parent)
		list_append(result, state)
		return result!

Void function execute_actions(model : Element, source_states : Element, target_states : Element, class_data : Element, data : Element, transition_source : String):
	Element exit
	Element entry
	exit = create_node()
	entry = create_node()

	source_states = set_copy(source_states)
	target_states = set_copy(target_states)

	// Add all exit and entry actions to the list of actions to execute
	// Do this by finding the common parent, and then doing all exit actions up to that node, and all entry actions up to the target_state

	// First, find the hierarchy!
	Element hierarchy_sources
	Element hierarchy_targets
	Element all_hierarchies

	hierarchy_sources = create_node()
	while (read_nr_out(source_states) > 0):
		set_add(hierarchy_sources, find_hierarchy(model, set_pop(source_states)))

	hierarchy_targets = create_node()
	while (read_nr_out(target_states) > 0):
		set_add(hierarchy_targets, find_hierarchy(model, set_pop(target_states)))

	all_hierarchies = set_copy(hierarchy_sources)
	set_merge(all_hierarchies, hierarchy_targets)

	// Difference these all lists, finding the first common entry
	Element iter_hierarchies
	Integer i
	String current
	Element hierarchy
	Boolean finished
	Integer transition_depth
	Integer lca_depth
	lca_depth = 0
	finished = False

	if (transition_source != ""):
		// Find out the level of the transition_source by fetching its hierarchy
		transition_depth = list_len(find_hierarchy(model, transition_source)) - 1

		// Now check for the least common ancestor
		while (bool_not(finished)):
			// Check the i-th element in both and see if they are equal
			current = ""
			iter_hierarchies = set_copy(all_hierarchies)
			while (read_nr_out(iter_hierarchies) > 0):
				hierarchy = set_pop(iter_hierarchies)

				// Exhausted one of the lists
				if (lca_depth >= list_len(hierarchy)):
					finished = True
					break!

				// Reached the same level as transition depth already, so no need to increase
				if (lca_depth == transition_depth):
					finished = True
					break!

				// First entry, so read out value as reference
				if (current == ""):
					current = list_read(hierarchy, lca_depth)

				// Check with reference element
				if (bool_not(value_eq(list_read(hierarchy, lca_depth), current))):
					finished = True
					break!

			// i-th element equal for all hierarchies, so go to next element
			if (bool_not(finished)):
				lca_depth = lca_depth + 1

		if (lca_depth < transition_depth):
			i = lca_depth
		else:
			i = transition_depth

	else:
		// Initial, so just set i to zero
		i = 0

	// Found the first differing element at position i

	// All elements remaining in hierarchy_source are to be traversed in REVERSE order for the exit actions
	// All elements remaining in hierarchy_target are to be traversed in NORMAL order for the entry actions
	// This is not that simple either, as we need to consider that some actions might already have been added to the list...

	// Add hierarchy_sources actions
	String state
	Element visited
	Element action
	Element spliced_hierarchy
	Element hierarchy_source
	Element hierarchy_target
	visited = create_node()
	while (read_nr_out(hierarchy_sources) > 0):
		// Get one of these hierarchies
		hierarchy_source = set_pop(hierarchy_sources)
		spliced_hierarchy = list_splice(hierarchy_source, i, list_len(hierarchy_source))
		while (list_len(spliced_hierarchy) > 0):
			state = list_pop(spliced_hierarchy, list_len(spliced_hierarchy) - 1)
			if (set_in(visited, state)):
				// Already added this state, so don't bother
				continue!
			else:
				// New state, so prepend it to the list
				// Prepend, instead of append, as we want to do these operations in reverse order!
				list_insert(exit, state, 0)

				// Add this state as visited
				set_add(visited, state)

	// Add hierarchy_targets actions
	// Clear visited, just to be safe, though it should not matter
	visited = create_node()
	while (read_nr_out(hierarchy_targets) > 0):
		// Get one of these hierarchies
		hierarchy_target = set_pop(hierarchy_targets)
		spliced_hierarchy = list_splice(hierarchy_target, i, list_len(hierarchy_target))
		while (list_len(spliced_hierarchy) > 0):
			state = list_pop(spliced_hierarchy, list_len(spliced_hierarchy) - 1)
			if (set_in(visited, state)):
				// Already added this state, so don't bother
				continue!
			else:
				// New state, so append it to the list
				// Append, instead of prepend, as we want to do these operations in normal order!
				list_append(entry, state)

				// Add this state as visited, even though there might not have been an associated action
				set_add(visited, state)

	// Now we have a list of traversed states!
	// Start executing all their operations in order

	Element events
	String event
	// First do exit actions
	while (read_nr_out(exit) > 0):
		state = list_pop(exit, 0)
		log("EXIT " + cast_v2s(read_attribute(model, state, "name")))

		// Set history when leaving
		if (read_type(model, state) == "SCCD/CompositeState"):
			dict_overwrite(class_data["history"], state, expand_current_state(model, state, class_data))

		// Do exit actions
		action = read_attribute(model, state, "onExitScript")
		if (element_neq(action, read_root())):
			// Got a script, so execute!
			action = get_func_AL_model(import_node(action))
			action(class_data["attributes"])

		// Raise events
		events = allAssociationDestinations(model, state, "SCCD/onExitRaise")
		while (read_nr_out(events) > 0):
			event = set_pop(events)

			Element parameter_action
			parameter_action = read_attribute(model, event, "parameter")
			if (element_neq(parameter_action, read_root())):
				// Got a parameter to evaluate
				parameter_action = get_func_AL_model(import_node(parameter_action))
				parameter_action = parameter_action(class_data["attributes"])

			process_raised_event(model, event, parameter_action, data)

		// Unschedule after events
		Element timed_transitions
		timed_transitions = filter_exists(model, allOutgoingAssociationInstances(model, state, "SCCD/transition"), "after")
		log("Checking for unschedule of timed transitions: " + set_to_string(timed_transitions))
		while (read_nr_out(timed_transitions) > 0):
			log("Unschedule timer")
			dict_delete(class_data["timers"], set_pop(timed_transitions))

	// Then do entry actions
	while (read_nr_out(entry) > 0):
		state = list_pop(entry, 0)
		log("ENTRY " + cast_v2s(read_attribute(model, state, "name")))

		// Do entry actions
		action = read_attribute(model, state, "onEntryScript")
		if (element_neq(action, read_root())):
			// Got a script, so execute!
			action = get_func_AL_model(import_node(action))
			action(class_data["attributes"])

		// Raise events
		events = allAssociationDestinations(model, state, "SCCD/onEntryRaise")
		while (read_nr_out(events) > 0):
			event = set_pop(events)

			Element parameter_action
			parameter_action = read_attribute(model, event, "parameter")
			if (element_neq(parameter_action, read_root())):
				// Got a parameter to evaluate
				parameter_action = get_func_AL_model(import_node(parameter_action))
				parameter_action = parameter_action(class_data["attributes"])

			process_raised_event(model, event, parameter_action, data)

		// Schedule after events
		Element timed_transitions
		String transition
		Element after
		timed_transitions = filter_exists(model, allOutgoingAssociationInstances(model, state, "SCCD/transition"), "after")
		log("Checking for schedule of timed transitions: " + set_to_string(timed_transitions))
		while (read_nr_out(timed_transitions) > 0):
			log("Schedule timer")
			transition = set_pop(timed_transitions)
			after = get_func_AL_model(import_node(read_attribute(model, transition, "after")))
			dict_add(class_data["timers"], transition, float_addition(data["start_time"], after(class_data["attributes"])))

	return !

Float function step(model : Element, data : Element):
	// Step through all classes
	Element classes
	Element class
	Float t_min
	Float t_current
	Boolean transitioned
	Element keys
	String key

	t_min = time() + 99999.0
	classes = dict_keys(data["classes"])

	// TODO this should use simulated time or something
	dict_overwrite(data, "start_time", time())

	transitioned = False
	while (read_nr_out(classes) > 0):
		class = set_pop(classes)
		if (step_class(model, data, class)):
			transitioned = True

		if (bool_not(transitioned)):
			// Find minimum timer for this class, and store that
			keys = dict_keys(data["classes"][class]["timers"])
			while (read_nr_out(keys) > 0):
				key = set_pop(keys)
				t_current = data["classes"][class]["timers"][key]
				if (t_current < t_min):
					t_min = t_current

	if (transitioned):
		// Do another step, as we can transition
		log("Transitioned, do another step!")
		return 0.0!
	else:
		log("Idle!")
		return float_subtraction(t_min, data["start_time"])!

Boolean function main(model : Element):
	// Executes the provided SCCD model
	Element data
	data = create_node()
	dict_add(data, "classes", create_node())

	// Prepare for input
	output("Ready for input!")

	// Find initial
	String default_class
	default_class = set_pop(filter(model, allInstances(model, "SCCD/Class"), "default", True))

	// Start up the default class
	start_class(model, data, default_class, "main", read_root())

	Float timeout
	Element interrupt
	timeout = 0.0
	while (True):
		print_states(model, data)
		interrupt = input_timeout(timeout)

		if (value_eq(interrupt, "#EXIT#")):
			// Stop execution
			return True!

		dict_overwrite(data, "events", create_node())
		if (element_neq(interrupt, read_root())):
			// Got interrupt
			log("Got event: " + cast_v2s(interrupt))
			set_add(data["events"], create_tuple(interrupt, read_root()))
			output("Processed event, ready for more!")

		timeout = step(model, data)

		if (read_nr_out(data["classes"]) == 0):
			// No more active classes left: terminate!
			log("Finished SCCD execution")
			break!
		log("Pausing for " + cast_v2s(timeout))

	// We should never get here!
	return False!