{ "format": "uvira.forge.blocks", "version": 1, "workspace": { "blocks": { "languageVersion": 0, "blocks": [ { "type": "forge_program", "id": "k475", "fields": { "NAME": "loop_pass", "PERIOD": "100" }, "inputs": { "INIT": { "block": { "type": "variables_set", "id": "k2", "fields": { "VAR": { "id": "var_n0" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k1", "fields": { "WHAT": "north" } } } }, "next": { "block": { "type": "variables_set", "id": "k4", "fields": { "VAR": { "id": "var_e0" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k3", "fields": { "WHAT": "east" } } } }, "next": { "block": { "type": "variables_set", "id": "k6", "fields": { "VAR": { "id": "var_h0" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k5", "fields": { "WHAT": "heading" } } } }, "next": { "block": { "type": "variables_set", "id": "k8", "fields": { "VAR": { "id": "var_a0" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k7", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "variables_set", "id": "k11", "fields": { "VAR": { "id": "var_ch0" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k10", "fields": { "OP": "COS" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k9", "fields": { "WHAT": "heading" } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k14", "fields": { "VAR": { "id": "var_sh0" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k13", "fields": { "OP": "SIN" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k12", "fields": { "WHAT": "heading" } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k16", "fields": { "VAR": { "id": "var_rad" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "n_20", "fields": { "NUM": 20 } } } }, "next": { "block": { "type": "variables_set", "id": "k18", "fields": { "VAR": { "id": "var_alt_bottom" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "n_40", "fields": { "NUM": 40 } } } }, "next": { "block": { "type": "variables_set", "id": "k20", "fields": { "VAR": { "id": "var_v_bottom" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "n_10", "fields": { "NUM": 10 } } } }, "next": { "block": { "type": "variables_set", "id": "k22", "fields": { "VAR": { "id": "var_v_top" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "n_15", "fields": { "NUM": 15 } } } }, "next": { "block": { "type": "variables_set", "id": "k24", "fields": { "VAR": { "id": "var_gain_r" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k23", "fields": { "NUM": 1.5 } } } }, "next": { "block": { "type": "variables_set", "id": "k26", "fields": { "VAR": { "id": "var_gain_d" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k25", "fields": { "NUM": 2.5 } } } }, "next": { "block": { "type": "variables_set", "id": "k28", "fields": { "VAR": { "id": "var_gain_v" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k27", "fields": { "NUM": 2.5 } } } }, "next": { "block": { "type": "variables_set", "id": "k30", "fields": { "VAR": { "id": "var_lead_s" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k29", "fields": { "NUM": 0.2 } } } }, "next": { "block": { "type": "variables_set", "id": "k32", "fields": { "VAR": { "id": "var_thr_cap" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k31", "fields": { "NUM": 0.85 } } } }, "next": { "block": { "type": "variables_set", "id": "k34", "fields": { "VAR": { "id": "var_smoke_lead" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k33", "fields": { "NUM": 2.5 } } } }, "next": { "block": { "type": "variables_set", "id": "k36", "fields": { "VAR": { "id": "var_smoke_after" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k35", "fields": { "NUM": 1 } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } }, "STATES": { "block": { "type": "forge_state", "id": "k79", "fields": { "NAME": "climb" }, "inputs": { "TICK": { "block": { "type": "forge_cmd_guided", "id": "k49", "fields": { "yaw_valid": true, "DISARM_WHEN_LANDED": false }, "inputs": { "pos_n": { "block": { "type": "variables_get", "id": "k45", "fields": { "VAR": { "id": "var_n0" } } } }, "pos_e": { "block": { "type": "variables_get", "id": "k46", "fields": { "VAR": { "id": "var_e0" } } } }, "alt": { "block": { "type": "math_constrain", "id": "k44", "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k41", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k40", "fields": { "VAR": { "id": "var_a0" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k39", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k38", "fields": { "NUM": 4 } } }, "B": { "block": { "type": "forge_time_in_state", "id": "k37" } } } } } } } }, "LOW": { "block": { "type": "math_number", "id": "k42", "fields": { "NUM": 0 } } }, "HIGH": { "block": { "type": "variables_get", "id": "k43", "fields": { "VAR": { "id": "var_alt_bottom" } } } } } } }, "yaw": { "block": { "type": "variables_get", "id": "k47", "fields": { "VAR": { "id": "var_h0" } } } }, "speed_max": { "block": { "type": "math_number", "id": "k48", "fields": { "NUM": 6 } } } }, "next": { "block": { "type": "forge_debug", "id": "k51", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k50", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "variables_set", "id": "k53", "fields": { "VAR": { "id": "var_aa" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k52", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "variables_set", "id": "k55", "fields": { "VAR": { "id": "var_cl" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k54", "fields": { "WHAT": "climb" } } } }, "next": { "block": { "type": "variables_set", "id": "k57", "fields": { "VAR": { "id": "var_ts" } }, "inputs": { "VALUE": { "block": { "type": "forge_time_in_state", "id": "k56" } } }, "next": { "block": { "type": "controls_if", "id": "k73", "inputs": { "IF0": { "block": { "type": "logic_operation", "id": "k71", "fields": { "OP": "AND" }, "inputs": { "A": { "block": { "type": "logic_operation", "id": "k67", "fields": { "OP": "AND" }, "inputs": { "A": { "block": { "type": "logic_compare", "id": "k62", "fields": { "OP": "GTE" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k61", "fields": { "VAR": { "id": "var_aa" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k60", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k58", "fields": { "VAR": { "id": "var_alt_bottom" } } } }, "B": { "block": { "type": "math_number", "id": "k59", "fields": { "NUM": 1 } } } } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k66", "fields": { "OP": "LT" }, "inputs": { "A": { "block": { "type": "math_single", "id": "k64", "fields": { "OP": "ABS" }, "inputs": { "NUM": { "block": { "type": "variables_get", "id": "k63", "fields": { "VAR": { "id": "var_cl" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k65", "fields": { "NUM": 1 } } } } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k70", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k68", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "k69", "fields": { "NUM": 3 } } } } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k72", "fields": { "NAME": "entry" } } } }, "next": { "block": { "type": "controls_if", "id": "k78", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k76", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k74", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "k75", "fields": { "NUM": 60 } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k77", "fields": { "NAME": "brake" } } } } } } } } } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "k134", "fields": { "NAME": "entry" }, "inputs": { "TICK": { "block": { "type": "forge_cmd_guided", "id": "k95", "fields": { "yaw_valid": true, "DISARM_WHEN_LANDED": false }, "inputs": { "pos_n": { "block": { "type": "math_arithmetic", "id": "k84", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k83", "fields": { "VAR": { "id": "var_n0" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k82", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k80", "fields": { "NUM": 300 } } }, "B": { "block": { "type": "variables_get", "id": "k81", "fields": { "VAR": { "id": "var_ch0" } } } } } } } } } }, "pos_e": { "block": { "type": "math_arithmetic", "id": "k89", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k88", "fields": { "VAR": { "id": "var_e0" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k87", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k85", "fields": { "NUM": 300 } } }, "B": { "block": { "type": "variables_get", "id": "k86", "fields": { "VAR": { "id": "var_sh0" } } } } } } } } } }, "alt": { "block": { "type": "variables_get", "id": "k90", "fields": { "VAR": { "id": "var_alt_bottom" } } } }, "yaw": { "block": { "type": "variables_get", "id": "k91", "fields": { "VAR": { "id": "var_h0" } } } }, "speed_max": { "block": { "type": "variables_get", "id": "p0", "fields": { "VAR": { "id": "var_v_bottom" } } } } }, "next": { "block": { "type": "variables_set", "id": "k97", "fields": { "VAR": { "id": "var_vn" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k96", "fields": { "WHAT": "vel_n" } } } }, "next": { "block": { "type": "variables_set", "id": "k99", "fields": { "VAR": { "id": "var_ve" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k98", "fields": { "WHAT": "vel_e" } } } }, "next": { "block": { "type": "variables_set", "id": "k101", "fields": { "VAR": { "id": "var_ts" } }, "inputs": { "VALUE": { "block": { "type": "forge_time_in_state", "id": "k100" } } }, "next": { "block": { "type": "variables_set", "id": "k109", "fields": { "VAR": { "id": "var_vpar" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k108", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k104", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k102", "fields": { "VAR": { "id": "var_vn" } } } }, "B": { "block": { "type": "variables_get", "id": "k103", "fields": { "VAR": { "id": "var_ch0" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k107", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k105", "fields": { "VAR": { "id": "var_ve" } } } }, "B": { "block": { "type": "variables_get", "id": "k106", "fields": { "VAR": { "id": "var_sh0" } } } } } } } } } } }, "next": { "block": { "type": "forge_debug", "id": "k111", "fields": { "INDEX": "2" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k110", "fields": { "VAR": { "id": "var_vpar" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k113", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k112", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "controls_if", "id": "k127", "inputs": { "IF0": { "block": { "type": "logic_operation", "id": "p4", "fields": { "OP": "AND" }, "inputs": { "A": { "block": { "type": "logic_compare", "id": "k125", "fields": { "OP": "GTE" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k124", "fields": { "VAR": { "id": "var_vpar" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k123", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k121", "fields": { "VAR": { "id": "var_v_bottom" } } } }, "B": { "block": { "type": "math_number", "id": "k122", "fields": { "NUM": 0.5 } } } } } } } } }, "B": { "block": { "type": "logic_compare", "id": "p1", "fields": { "OP": "GTE" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "p2", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "p3", "fields": { "NUM": 9 } } } } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k126", "fields": { "NAME": "loop" } } } }, "next": { "block": { "type": "controls_if", "id": "k133", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k130", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k128", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "k129", "fields": { "NUM": 25 } } } } } }, "DO0": { "block": { "type": "forge_payload_power", "id": "k131", "fields": { "ON": "OFF" }, "next": { "block": { "type": "forge_goto", "id": "k132", "fields": { "NAME": "brake" } } } } } } } } } } } } } } } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "k411", "fields": { "NAME": "loop" }, "inputs": { "TICK": { "block": { "type": "variables_set", "id": "k136", "fields": { "VAR": { "id": "var_nn" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k135", "fields": { "WHAT": "north" } } } }, "next": { "block": { "type": "variables_set", "id": "k138", "fields": { "VAR": { "id": "var_ee" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k137", "fields": { "WHAT": "east" } } } }, "next": { "block": { "type": "variables_set", "id": "k140", "fields": { "VAR": { "id": "var_aa" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k139", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "variables_set", "id": "k142", "fields": { "VAR": { "id": "var_vn" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k141", "fields": { "WHAT": "vel_n" } } } }, "next": { "block": { "type": "variables_set", "id": "k144", "fields": { "VAR": { "id": "var_ve" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k143", "fields": { "WHAT": "vel_e" } } } }, "next": { "block": { "type": "variables_set", "id": "k146", "fields": { "VAR": { "id": "var_cl" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k145", "fields": { "WHAT": "climb" } } } }, "next": { "block": { "type": "variables_set", "id": "k148", "fields": { "VAR": { "id": "var_ts" } }, "inputs": { "VALUE": { "block": { "type": "forge_time_in_state", "id": "k147" } } }, "next": { "block": { "type": "variables_set", "id": "k152", "fields": { "VAR": { "id": "var_rn" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k151", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k149", "fields": { "VAR": { "id": "var_nn" } } } }, "B": { "block": { "type": "variables_get", "id": "k150", "fields": { "VAR": { "id": "var_cn" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k156", "fields": { "VAR": { "id": "var_re" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k155", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k153", "fields": { "VAR": { "id": "var_ee" } } } }, "B": { "block": { "type": "variables_get", "id": "k154", "fields": { "VAR": { "id": "var_ce" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k164", "fields": { "VAR": { "id": "var_rx" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k163", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k159", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k157", "fields": { "VAR": { "id": "var_rn" } } } }, "B": { "block": { "type": "variables_get", "id": "k158", "fields": { "VAR": { "id": "var_ch" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k162", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k160", "fields": { "VAR": { "id": "var_re" } } } }, "B": { "block": { "type": "variables_get", "id": "k161", "fields": { "VAR": { "id": "var_sh" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k172", "fields": { "VAR": { "id": "var_cc" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k171", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k167", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k165", "fields": { "VAR": { "id": "var_re" } } } }, "B": { "block": { "type": "variables_get", "id": "k166", "fields": { "VAR": { "id": "var_ch" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k170", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k168", "fields": { "VAR": { "id": "var_rn" } } } }, "B": { "block": { "type": "variables_get", "id": "k169", "fields": { "VAR": { "id": "var_sh" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k176", "fields": { "VAR": { "id": "var_zz" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k175", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k173", "fields": { "VAR": { "id": "var_ca" } } } }, "B": { "block": { "type": "variables_get", "id": "k174", "fields": { "VAR": { "id": "var_aa" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k185", "fields": { "VAR": { "id": "var_r" } }, "inputs": { "VALUE": { "block": { "type": "math_single", "id": "k184", "fields": { "OP": "ROOT" }, "inputs": { "NUM": { "block": { "type": "math_arithmetic", "id": "k183", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k179", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k177", "fields": { "VAR": { "id": "var_rx" } } } }, "B": { "block": { "type": "variables_get", "id": "k178", "fields": { "VAR": { "id": "var_rx" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k182", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k180", "fields": { "VAR": { "id": "var_zz" } } } }, "B": { "block": { "type": "variables_get", "id": "k181", "fields": { "VAR": { "id": "var_zz" } } } } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k189", "fields": { "VAR": { "id": "var_phi" } }, "inputs": { "VALUE": { "block": { "type": "math_atan2", "id": "k188", "inputs": { "X": { "block": { "type": "variables_get", "id": "k186", "fields": { "VAR": { "id": "var_zz" } } } }, "Y": { "block": { "type": "variables_get", "id": "k187", "fields": { "VAR": { "id": "var_rx" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k192", "fields": { "VAR": { "id": "var_cph" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k191", "fields": { "OP": "COS" }, "inputs": { "NUM": { "block": { "type": "variables_get", "id": "k190", "fields": { "VAR": { "id": "var_phi" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k195", "fields": { "VAR": { "id": "var_sph" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k194", "fields": { "OP": "SIN" }, "inputs": { "NUM": { "block": { "type": "variables_get", "id": "k193", "fields": { "VAR": { "id": "var_phi" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k199", "fields": { "VAR": { "id": "var_dphi" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k198", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k196", "fields": { "VAR": { "id": "var_phi" } } } }, "B": { "block": { "type": "variables_get", "id": "k197", "fields": { "VAR": { "id": "var_phiprev" } } } } } } } }, "next": { "block": { "type": "controls_if", "id": "k207", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k202", "fields": { "OP": "LT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k200", "fields": { "VAR": { "id": "var_dphi" } } } }, "B": { "block": { "type": "math_number", "id": "k201", "fields": { "NUM": -180 } } } } } }, "DO0": { "block": { "type": "variables_set", "id": "k206", "fields": { "VAR": { "id": "var_dphi" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k205", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k203", "fields": { "VAR": { "id": "var_dphi" } } } }, "B": { "block": { "type": "math_number", "id": "k204", "fields": { "NUM": 360 } } } } } } } } } }, "next": { "block": { "type": "controls_if", "id": "k215", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k210", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k208", "fields": { "VAR": { "id": "var_dphi" } } } }, "B": { "block": { "type": "math_number", "id": "k209", "fields": { "NUM": 180 } } } } } }, "DO0": { "block": { "type": "variables_set", "id": "k214", "fields": { "VAR": { "id": "var_dphi" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k213", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k211", "fields": { "VAR": { "id": "var_dphi" } } } }, "B": { "block": { "type": "math_number", "id": "k212", "fields": { "NUM": 360 } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k219", "fields": { "VAR": { "id": "var_prog" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k218", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k216", "fields": { "VAR": { "id": "var_prog" } } } }, "B": { "block": { "type": "variables_get", "id": "k217", "fields": { "VAR": { "id": "var_dphi" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k221", "fields": { "VAR": { "id": "var_phiprev" } }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k220", "fields": { "VAR": { "id": "var_phi" } } } } }, "next": { "block": { "type": "variables_set", "id": "k229", "fields": { "VAR": { "id": "var_vpar" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k228", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k224", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k222", "fields": { "VAR": { "id": "var_vn" } } } }, "B": { "block": { "type": "variables_get", "id": "k223", "fields": { "VAR": { "id": "var_ch" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k227", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k225", "fields": { "VAR": { "id": "var_ve" } } } }, "B": { "block": { "type": "variables_get", "id": "k226", "fields": { "VAR": { "id": "var_sh" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k237", "fields": { "VAR": { "id": "var_vt" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k236", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k232", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k230", "fields": { "VAR": { "id": "var_vpar" } } } }, "B": { "block": { "type": "variables_get", "id": "k231", "fields": { "VAR": { "id": "var_cph" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k235", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k233", "fields": { "VAR": { "id": "var_cl" } } } }, "B": { "block": { "type": "variables_get", "id": "k234", "fields": { "VAR": { "id": "var_sph" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k245", "fields": { "VAR": { "id": "var_vr" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k244", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k240", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k238", "fields": { "VAR": { "id": "var_vpar" } } } }, "B": { "block": { "type": "variables_get", "id": "k239", "fields": { "VAR": { "id": "var_sph" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k243", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k241", "fields": { "VAR": { "id": "var_cl" } } } }, "B": { "block": { "type": "variables_get", "id": "k242", "fields": { "VAR": { "id": "var_cph" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k249", "fields": { "VAR": { "id": "var_e" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k248", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k246", "fields": { "VAR": { "id": "var_r" } } } }, "B": { "block": { "type": "variables_get", "id": "k247", "fields": { "VAR": { "id": "var_rad" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k255", "fields": { "VAR": { "id": "var_vdes" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k254", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k253", "fields": { "VAR": { "id": "var_mid_v" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k252", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k250", "fields": { "VAR": { "id": "var_half_dv" } } } }, "B": { "block": { "type": "variables_get", "id": "k251", "fields": { "VAR": { "id": "var_cph" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k273", "fields": { "VAR": { "id": "var_tin" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k272", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k268", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k264", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k260", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k258", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k256", "fields": { "VAR": { "id": "var_vt" } } } }, "B": { "block": { "type": "variables_get", "id": "k257", "fields": { "VAR": { "id": "var_vt" } } } } } } }, "B": { "block": { "type": "variables_get", "id": "k259", "fields": { "VAR": { "id": "var_inv_rad" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k263", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k261", "fields": { "VAR": { "id": "var_gain_r" } } } }, "B": { "block": { "type": "variables_get", "id": "k262", "fields": { "VAR": { "id": "var_e" } } } } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k267", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k265", "fields": { "VAR": { "id": "var_gain_d" } } } }, "B": { "block": { "type": "variables_get", "id": "k266", "fields": { "VAR": { "id": "var_vr" } } } } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k271", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k269", "fields": { "NUM": 9.81 } } }, "B": { "block": { "type": "variables_get", "id": "k270", "fields": { "VAR": { "id": "var_cph" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k283", "fields": { "VAR": { "id": "var_tt" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k282", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k278", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k277", "fields": { "VAR": { "id": "var_gain_v" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k276", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k274", "fields": { "VAR": { "id": "var_vdes" } } } }, "B": { "block": { "type": "variables_get", "id": "k275", "fields": { "VAR": { "id": "var_vt" } } } } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k281", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k279", "fields": { "NUM": 9.81 } } }, "B": { "block": { "type": "variables_get", "id": "k280", "fields": { "VAR": { "id": "var_sph" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k292", "fields": { "VAR": { "id": "var_tm" } }, "inputs": { "VALUE": { "block": { "type": "math_single", "id": "k291", "fields": { "OP": "ROOT" }, "inputs": { "NUM": { "block": { "type": "math_arithmetic", "id": "k290", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k286", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k284", "fields": { "VAR": { "id": "var_tin" } } } }, "B": { "block": { "type": "variables_get", "id": "k285", "fields": { "VAR": { "id": "var_tin" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k289", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k287", "fields": { "VAR": { "id": "var_tt" } } } }, "B": { "block": { "type": "variables_get", "id": "k288", "fields": { "VAR": { "id": "var_tt" } } } } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k296", "fields": { "VAR": { "id": "var_delta" } }, "inputs": { "VALUE": { "block": { "type": "math_atan2", "id": "k295", "inputs": { "X": { "block": { "type": "variables_get", "id": "k293", "fields": { "VAR": { "id": "var_tin" } } } }, "Y": { "block": { "type": "variables_get", "id": "k294", "fields": { "VAR": { "id": "var_tt" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k304", "fields": { "VAR": { "id": "var_thc" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k303", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k299", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k297", "fields": { "VAR": { "id": "var_phi" } } } }, "B": { "block": { "type": "variables_get", "id": "k298", "fields": { "VAR": { "id": "var_delta" } } } } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k302", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k300", "fields": { "VAR": { "id": "var_vt" } } } }, "B": { "block": { "type": "variables_get", "id": "k301", "fields": { "VAR": { "id": "var_lead_k" } } } } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k312", "fields": { "VAR": { "id": "var_thc" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k311", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "math_modulo", "id": "k309", "inputs": { "DIVIDEND": { "block": { "type": "math_arithmetic", "id": "k307", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k305", "fields": { "VAR": { "id": "var_thc" } } } }, "B": { "block": { "type": "math_number", "id": "k306", "fields": { "NUM": 540 } } } } } }, "DIVISOR": { "block": { "type": "math_number", "id": "k308", "fields": { "NUM": 360 } } } } } }, "B": { "block": { "type": "math_number", "id": "k310", "fields": { "NUM": 180 } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k319", "fields": { "VAR": { "id": "var_thro" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k318", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_constrain", "id": "k316", "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k313", "fields": { "VAR": { "id": "var_tm" } } } }, "LOW": { "block": { "type": "math_number", "id": "k314", "fields": { "NUM": 0 } } }, "HIGH": { "block": { "type": "variables_get", "id": "k315", "fields": { "VAR": { "id": "var_tmax_f" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k317", "fields": { "NUM": 0.050968 } } } } } } }, "next": { "block": { "type": "forge_cmd_stabilise", "id": "k324", "fields": { "DISARM_WHEN_LANDED": false }, "inputs": { "roll": { "block": { "type": "math_number", "id": "k320", "fields": { "NUM": 0 } } }, "pitch": { "block": { "type": "variables_get", "id": "k321", "fields": { "VAR": { "id": "var_thc" } } } }, "yaw_rate": { "block": { "type": "math_number", "id": "k322", "fields": { "NUM": 0 } } }, "throttle": { "block": { "type": "variables_get", "id": "k323", "fields": { "VAR": { "id": "var_thro" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k326", "fields": { "INDEX": "0" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k325", "fields": { "VAR": { "id": "var_phi" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k328", "fields": { "INDEX": "1" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k327", "fields": { "VAR": { "id": "var_e" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k330", "fields": { "INDEX": "2" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k329", "fields": { "VAR": { "id": "var_vt" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k332", "fields": { "INDEX": "3" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k331", "fields": { "VAR": { "id": "var_cc" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k334", "fields": { "INDEX": "4" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k333", "fields": { "VAR": { "id": "var_thc" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k336", "fields": { "INDEX": "6" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k335", "fields": { "VAR": { "id": "var_thro" } } } } }, "next": { "block": { "type": "forge_debug", "id": "k338", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "variables_get", "id": "k337", "fields": { "VAR": { "id": "var_aa" } } } } }, "next": { "block": { "type": "controls_if", "id": "k343", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k341", "fields": { "OP": "GTE" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k339", "fields": { "VAR": { "id": "var_prog" } } } }, "B": { "block": { "type": "math_number", "id": "k340", "fields": { "NUM": 355 } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k342", "fields": { "NAME": "exit" } } } }, "next": { "block": { "type": "controls_if", "id": "k364", "inputs": { "IF0": { "block": { "type": "logic_operation", "id": "k362", "fields": { "OP": "OR" }, "inputs": { "A": { "block": { "type": "logic_operation", "id": "k361", "fields": { "OP": "OR" }, "inputs": { "A": { "block": { "type": "logic_operation", "id": "k360", "fields": { "OP": "OR" }, "inputs": { "A": { "block": { "type": "logic_compare", "id": "k347", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "math_single", "id": "k345", "fields": { "OP": "ABS" }, "inputs": { "NUM": { "block": { "type": "variables_get", "id": "k344", "fields": { "VAR": { "id": "var_e" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k346", "fields": { "NUM": 10 } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k351", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "math_single", "id": "k349", "fields": { "OP": "ABS" }, "inputs": { "NUM": { "block": { "type": "variables_get", "id": "k348", "fields": { "VAR": { "id": "var_cc" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k350", "fields": { "NUM": 25 } } } } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k356", "fields": { "OP": "LT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k355", "fields": { "VAR": { "id": "var_aa" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "k354", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k352", "fields": { "VAR": { "id": "var_alt_bottom" } } } }, "B": { "block": { "type": "math_number", "id": "k353", "fields": { "NUM": 12 } } } } } } } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k359", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k357", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "k358", "fields": { "NUM": 45 } } } } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k363", "fields": { "NAME": "rescue" } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } } }, "ENTRY": { "block": { "type": "variables_set", "id": "k366", "fields": { "VAR": { "id": "var_cn" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k365", "fields": { "WHAT": "north" } } } }, "next": { "block": { "type": "variables_set", "id": "k368", "fields": { "VAR": { "id": "var_ce" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k367", "fields": { "WHAT": "east" } } } }, "next": { "block": { "type": "variables_set", "id": "k372", "fields": { "VAR": { "id": "var_ca" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k371", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "forge_vehicle_value", "id": "k369", "fields": { "WHAT": "alt" } } }, "B": { "block": { "type": "variables_get", "id": "k370", "fields": { "VAR": { "id": "var_rad" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k374", "fields": { "VAR": { "id": "var_hl" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k373", "fields": { "WHAT": "heading" } } } }, "next": { "block": { "type": "variables_set", "id": "k377", "fields": { "VAR": { "id": "var_ch" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k376", "fields": { "OP": "COS" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k375", "fields": { "WHAT": "heading" } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k380", "fields": { "VAR": { "id": "var_sh" } }, "inputs": { "VALUE": { "block": { "type": "math_trig", "id": "k379", "fields": { "OP": "SIN" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k378", "fields": { "WHAT": "heading" } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k382", "fields": { "VAR": { "id": "var_phiprev" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k381", "fields": { "NUM": 0 } } } }, "next": { "block": { "type": "variables_set", "id": "k384", "fields": { "VAR": { "id": "var_prog" } }, "inputs": { "VALUE": { "block": { "type": "math_number", "id": "k383", "fields": { "NUM": 0 } } } }, "next": { "block": { "type": "variables_set", "id": "k388", "fields": { "VAR": { "id": "var_inv_rad" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k387", "fields": { "OP": "DIVIDE" }, "inputs": { "A": { "block": { "type": "math_number", "id": "k385", "fields": { "NUM": 1 } } }, "B": { "block": { "type": "variables_get", "id": "k386", "fields": { "VAR": { "id": "var_rad" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k394", "fields": { "VAR": { "id": "var_mid_v" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k393", "fields": { "OP": "DIVIDE" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k391", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k389", "fields": { "VAR": { "id": "var_v_bottom" } } } }, "B": { "block": { "type": "variables_get", "id": "k390", "fields": { "VAR": { "id": "var_v_top" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k392", "fields": { "NUM": 2 } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k400", "fields": { "VAR": { "id": "var_half_dv" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k399", "fields": { "OP": "DIVIDE" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k397", "fields": { "OP": "MINUS" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k395", "fields": { "VAR": { "id": "var_v_bottom" } } } }, "B": { "block": { "type": "variables_get", "id": "k396", "fields": { "VAR": { "id": "var_v_top" } } } } } } }, "B": { "block": { "type": "math_number", "id": "k398", "fields": { "NUM": 2 } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k406", "fields": { "VAR": { "id": "var_lead_k" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k405", "fields": { "OP": "DIVIDE" }, "inputs": { "A": { "block": { "type": "math_arithmetic", "id": "k403", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k401", "fields": { "VAR": { "id": "var_lead_s" } } } }, "B": { "block": { "type": "math_number", "id": "k402", "fields": { "NUM": 57.3 } } } } } }, "B": { "block": { "type": "variables_get", "id": "k404", "fields": { "VAR": { "id": "var_rad" } } } } } } } }, "next": { "block": { "type": "variables_set", "id": "k410", "fields": { "VAR": { "id": "var_tmax_f" } }, "inputs": { "VALUE": { "block": { "type": "math_arithmetic", "id": "k409", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k407", "fields": { "VAR": { "id": "var_thr_cap" } } } }, "B": { "block": { "type": "math_number", "id": "k408", "fields": { "NUM": 19.62 } } } } } } }, "next": { "block": { "type": "forge_payload_power", "id": "p5", "fields": { "ON": "ON" } } } } } } } } } } } } } } } } } } } } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "p28", "fields": { "NAME": "exit" }, "inputs": { "ENTRY": { "block": { "type": "forge_payload_power", "id": "p29", "fields": { "ON": "OFF" }, "next": { "block": { "type": "variables_set", "id": "p30", "fields": { "VAR": { "id": "var_exit_alt" } }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "p31", "fields": { "WHAT": "alt" } } } } } } } }, "TICK": { "block": { "type": "forge_cmd_guided", "id": "p6", "fields": { "yaw_valid": true, "DISARM_WHEN_LANDED": false }, "inputs": { "pos_n": { "block": { "type": "math_arithmetic", "id": "p7", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "p8", "fields": { "VAR": { "id": "var_n0" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "p9", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "p10", "fields": { "NUM": 300 } } }, "B": { "block": { "type": "variables_get", "id": "p11", "fields": { "VAR": { "id": "var_ch0" } } } } } } } } } }, "pos_e": { "block": { "type": "math_arithmetic", "id": "p12", "fields": { "OP": "ADD" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "p13", "fields": { "VAR": { "id": "var_e0" } } } }, "B": { "block": { "type": "math_arithmetic", "id": "p14", "fields": { "OP": "MULTIPLY" }, "inputs": { "A": { "block": { "type": "math_number", "id": "p15", "fields": { "NUM": 300 } } }, "B": { "block": { "type": "variables_get", "id": "p16", "fields": { "VAR": { "id": "var_sh0" } } } } } } } } } }, "alt": { "block": { "type": "variables_get", "id": "p20", "fields": { "VAR": { "id": "var_exit_alt" } } } }, "yaw": { "block": { "type": "variables_get", "id": "p18", "fields": { "VAR": { "id": "var_h0" } } } }, "speed_max": { "block": { "type": "variables_get", "id": "p19", "fields": { "VAR": { "id": "var_v_bottom" } } } } }, "next": { "block": { "type": "variables_set", "id": "p21", "fields": { "VAR": { "id": "var_ts" } }, "inputs": { "VALUE": { "block": { "type": "forge_time_in_state", "id": "p22" } } }, "next": { "block": { "type": "controls_if", "id": "p23", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "p24", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "p25", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "p26", "fields": { "NUM": 10 } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "p27", "fields": { "NAME": "brake" } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "k445", "fields": { "NAME": "rescue" }, "inputs": { "TICK": { "block": { "type": "forge_payload_power", "id": "k412", "fields": { "ON": "OFF" }, "next": { "block": { "type": "forge_cmd_stabilise", "id": "k417", "fields": { "DISARM_WHEN_LANDED": false }, "inputs": { "roll": { "block": { "type": "math_number", "id": "k413", "fields": { "NUM": 0 } } }, "pitch": { "block": { "type": "math_number", "id": "k414", "fields": { "NUM": 0 } } }, "yaw_rate": { "block": { "type": "math_number", "id": "k415", "fields": { "NUM": 0 } } }, "throttle": { "block": { "type": "math_number", "id": "k416", "fields": { "NUM": 0.3 } } } }, "next": { "block": { "type": "controls_if", "id": "k427", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k421", "fields": { "OP": "LT" }, "inputs": { "A": { "block": { "type": "math_single", "id": "k419", "fields": { "OP": "ABS" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k418", "fields": { "WHAT": "pitch" } } } } } }, "B": { "block": { "type": "math_number", "id": "k420", "fields": { "NUM": 60 } } } } } }, "DO0": { "block": { "type": "forge_cmd_stabilise", "id": "k426", "fields": { "DISARM_WHEN_LANDED": false }, "inputs": { "roll": { "block": { "type": "math_number", "id": "k422", "fields": { "NUM": 0 } } }, "pitch": { "block": { "type": "math_number", "id": "k423", "fields": { "NUM": 0 } } }, "yaw_rate": { "block": { "type": "math_number", "id": "k424", "fields": { "NUM": 0 } } }, "throttle": { "block": { "type": "math_number", "id": "k425", "fields": { "NUM": 0.9 } } } } } } }, "next": { "block": { "type": "forge_debug", "id": "k429", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k428", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "controls_if", "id": "k439", "inputs": { "IF0": { "block": { "type": "logic_operation", "id": "k437", "fields": { "OP": "AND" }, "inputs": { "A": { "block": { "type": "logic_compare", "id": "k432", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "forge_vehicle_value", "id": "k430", "fields": { "WHAT": "climb" } } }, "B": { "block": { "type": "math_number", "id": "k431", "fields": { "NUM": -2 } } } } } }, "B": { "block": { "type": "logic_compare", "id": "k436", "fields": { "OP": "LT" }, "inputs": { "A": { "block": { "type": "math_single", "id": "k434", "fields": { "OP": "ABS" }, "inputs": { "NUM": { "block": { "type": "forge_vehicle_value", "id": "k433", "fields": { "WHAT": "pitch" } } } } } }, "B": { "block": { "type": "math_number", "id": "k435", "fields": { "NUM": 25 } } } } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k438", "fields": { "NAME": "brake" } } } }, "next": { "block": { "type": "controls_if", "id": "k444", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k442", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "forge_time_in_state", "id": "k440" } }, "B": { "block": { "type": "math_number", "id": "k441", "fields": { "NUM": 8 } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k443", "fields": { "NAME": "brake" } } } } } } } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "k468", "fields": { "NAME": "brake" }, "inputs": { "TICK": { "block": { "type": "forge_cmd_loiter", "id": "k451", "fields": { "frame": "HEADING", "yaw_valid": true, "DISARM_WHEN_LANDED": false }, "inputs": { "vel_x": { "block": { "type": "math_number", "id": "k446", "fields": { "NUM": 0 } } }, "vel_y": { "block": { "type": "math_number", "id": "k447", "fields": { "NUM": 0 } } }, "climb_rate": { "block": { "type": "math_number", "id": "k448", "fields": { "NUM": 0 } } }, "yaw_rate": { "block": { "type": "math_number", "id": "k449", "fields": { "NUM": 0 } } }, "yaw": { "block": { "type": "variables_get", "id": "k450", "fields": { "VAR": { "id": "var_h0" } } } } }, "next": { "block": { "type": "variables_set", "id": "k453", "fields": { "VAR": { "id": "var_ts" } }, "inputs": { "VALUE": { "block": { "type": "forge_time_in_state", "id": "k452" } } }, "next": { "block": { "type": "controls_if", "id": "k458", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k456", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k454", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "variables_get", "id": "k455", "fields": { "VAR": { "id": "var_smoke_after" } } } } } } }, "DO0": { "block": { "type": "forge_payload_power", "id": "k457", "fields": { "ON": "OFF" } } } }, "next": { "block": { "type": "forge_debug", "id": "k460", "fields": { "INDEX": "2" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k459", "fields": { "WHAT": "ground_speed" } } } }, "next": { "block": { "type": "forge_debug", "id": "k462", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k461", "fields": { "WHAT": "alt" } } } }, "next": { "block": { "type": "controls_if", "id": "k467", "inputs": { "IF0": { "block": { "type": "logic_compare", "id": "k465", "fields": { "OP": "GT" }, "inputs": { "A": { "block": { "type": "variables_get", "id": "k463", "fields": { "VAR": { "id": "var_ts" } } } }, "B": { "block": { "type": "math_number", "id": "k464", "fields": { "NUM": 10 } } } } } }, "DO0": { "block": { "type": "forge_goto", "id": "k466", "fields": { "NAME": "land" } } } } } } } } } } } } } } } } }, "next": { "block": { "type": "forge_state", "id": "k474", "fields": { "NAME": "land" }, "inputs": { "TICK": { "block": { "type": "forge_cmd_land", "id": "k471", "fields": {}, "inputs": { "vel_x": { "block": { "type": "math_number", "id": "k469", "fields": { "NUM": 0 } } }, "vel_y": { "block": { "type": "math_number", "id": "k470", "fields": { "NUM": 0 } } } }, "next": { "block": { "type": "forge_debug", "id": "k473", "fields": { "INDEX": "7" }, "inputs": { "VALUE": { "block": { "type": "forge_vehicle_value", "id": "k472", "fields": { "WHAT": "alt" } } } } } } } } } } } } } } } } } } } } } } } }, "x": 40, "y": 40 } ] }, "variables": [ { "name": "n0", "id": "var_n0" }, { "name": "e0", "id": "var_e0" }, { "name": "h0", "id": "var_h0" }, { "name": "a0", "id": "var_a0" }, { "name": "ch0", "id": "var_ch0" }, { "name": "sh0", "id": "var_sh0" }, { "name": "rad", "id": "var_rad" }, { "name": "alt_bottom", "id": "var_alt_bottom" }, { "name": "v_bottom", "id": "var_v_bottom" }, { "name": "v_top", "id": "var_v_top" }, { "name": "gain_r", "id": "var_gain_r" }, { "name": "gain_d", "id": "var_gain_d" }, { "name": "gain_v", "id": "var_gain_v" }, { "name": "lead_s", "id": "var_lead_s" }, { "name": "thr_cap", "id": "var_thr_cap" }, { "name": "smoke_lead", "id": "var_smoke_lead" }, { "name": "smoke_after", "id": "var_smoke_after" }, { "name": "cn", "id": "var_cn" }, { "name": "ce", "id": "var_ce" }, { "name": "ca", "id": "var_ca" }, { "name": "hl", "id": "var_hl" }, { "name": "ch", "id": "var_ch" }, { "name": "sh", "id": "var_sh" }, { "name": "inv_rad", "id": "var_inv_rad" }, { "name": "mid_v", "id": "var_mid_v" }, { "name": "half_dv", "id": "var_half_dv" }, { "name": "lead_k", "id": "var_lead_k" }, { "name": "tmax_f", "id": "var_tmax_f" }, { "name": "nn", "id": "var_nn" }, { "name": "ee", "id": "var_ee" }, { "name": "aa", "id": "var_aa" }, { "name": "vn", "id": "var_vn" }, { "name": "ve", "id": "var_ve" }, { "name": "cl", "id": "var_cl" }, { "name": "ts", "id": "var_ts" }, { "name": "rn", "id": "var_rn" }, { "name": "re", "id": "var_re" }, { "name": "rx", "id": "var_rx" }, { "name": "cc", "id": "var_cc" }, { "name": "zz", "id": "var_zz" }, { "name": "r", "id": "var_r" }, { "name": "phi", "id": "var_phi" }, { "name": "cph", "id": "var_cph" }, { "name": "sph", "id": "var_sph" }, { "name": "phiprev", "id": "var_phiprev" }, { "name": "dphi", "id": "var_dphi" }, { "name": "prog", "id": "var_prog" }, { "name": "vpar", "id": "var_vpar" }, { "name": "vt", "id": "var_vt" }, { "name": "vr", "id": "var_vr" }, { "name": "e", "id": "var_e" }, { "name": "vdes", "id": "var_vdes" }, { "name": "tin", "id": "var_tin" }, { "name": "tt", "id": "var_tt" }, { "name": "tm", "id": "var_tm" }, { "name": "delta", "id": "var_delta" }, { "name": "thc", "id": "var_thc" }, { "name": "thro", "id": "var_thro" }, { "name": "exit_alt", "id": "var_exit_alt" } ], "actors": [ { "id": "smoke", "name": "Smoke trail", "asset": "user_smoke_generator", "assetName": "Smoke generator", "motion": "attached", "position": [ 0, 0, 0 ], "rotationDeg": [ 0, 0, 180 ], "waypoints": [ [ 0, 0, 0 ] ], "speedMps": 5, "loop": "back_and_forth", "attachTo": "vehicle", "offset": [ -0.3, 0, 0 ], "markerFamily": "aruco_4x4_50", "markerId": 0, "markerSizeM": 1, "smoke": { "intensity": 0.7, "colour": [ 240, 240, 240 ], "exitSpeedMps": 4, "lifeS": 12, "sizeM": 0.05, "nozzle": [ 0, 0, 0 ] }, "switchedBy": "j4" } ] } }