338 lines
12 KiB
XML
338 lines
12 KiB
XML
<?xml version="1.0" encoding="UTF-8"?>
|
|
<graphml xmlns="http://graphml.graphdrawing.org/xmlns">
|
|
<data key="gFormat">Cyberiada-GraphML-1.0</data>
|
|
<key id="gFormat" for="graphml" attr.name="format" attr.type="string"/>
|
|
<key id="dName" for="graph" attr.name="name" attr.type="string"/>
|
|
<key id="dName" for="node" attr.name="name" attr.type="string"/>
|
|
<key id="dStateMachine" for="graph" attr.name="stateMachine" attr.type="string"/>
|
|
<key id="dSubmachineState" for="node" attr.name="submachineState" attr.type="string"/>
|
|
<key id="dGeometry" for="graph" attr.name="geometry"/>
|
|
<key id="dGeometry" for="node" attr.name="geometry"/>
|
|
<key id="dGeometry" for="edge" attr.name="geometry"/>
|
|
<key id="dSourcePoint" for="edge" attr.name="sourcePoint"/>
|
|
<key id="dTargetPoint" for="edge" attr.name="targetPoint"/>
|
|
<key id="dLabelGeometry" for="edge" attr.name="labelGeometry"/>
|
|
<key id="dNote" for="node" attr.name="note" attr.type="string"/>
|
|
<key id="dVertex" for="node" attr.name="vertex" attr.type="string"/>
|
|
<key id="dData" for="node" attr.name="data" attr.type="string"/>
|
|
<key id="dData" for="edge" attr.name="data" attr.type="string"/>
|
|
<key id="dMarkup" for="node" attr.name="markup" attr.type="string"/>
|
|
<key id="dColor" for="node" attr.name="color" attr.type="string"/>
|
|
<key id="dColor" for="edge" attr.name="color" attr.type="string"/>
|
|
<key id="dPivot" for="edge" attr.name="pivot" attr.type="string"/>
|
|
<key id="dChunk" for="edge" attr.name="chunk" attr.type="string"/>
|
|
<graph id="G" edgedefault="directed">
|
|
<data key="dName">orientation</data>
|
|
<node id="nMeta">
|
|
<data key="dNote">formal</data>
|
|
<data key="dName">CGML_META</data>
|
|
<data key="dData">standardVersion/ 1.0
|
|
|
|
name/ orientation
|
|
|
|
transitionOrder/ transitionFirst
|
|
|
|
eventPropagation/ block
|
|
|
|
</data>
|
|
</node>
|
|
<node id="n0">
|
|
<data key="dName">orientation</data>
|
|
<data key="dData">entry/</data>
|
|
<data key="dGeometry">
|
|
<rect x="409.904572" y="50.595303" width="1149.475220" height="725.384277"/>
|
|
</data>
|
|
<graph id="n0:" edgedefault="directed">
|
|
<node id="n0::n0">
|
|
<data key="dName">turn</data>
|
|
<data key="dData">entry/
|
|
orientation.start_motor(AXIS_Z)
|
|
|
|
exit/
|
|
orientation.stop_motor(AXIS_Z)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="445.462036" y="97.713547" width="297.494720" height="506.212646"/>
|
|
</data>
|
|
<graph id="n0::n0:" edgedefault="directed">
|
|
<node id="n0::n0::n0">
|
|
<data key="dName">slow_down</data>
|
|
<data key="dData">entry/
|
|
reduce_speed()
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="460.462036" y="286.453033" width="267.494720" height="69.211853"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n0::n1">
|
|
<data key="dName">start_turn</data>
|
|
<data key="dData">entry/
|
|
calculate_turn()
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="460.462036" y="396.384155" width="267.494720" height="69.211853"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n0::n2">
|
|
<data key="dVertex">initial</data>
|
|
<data key="dName"></data>
|
|
<data key="dGeometry">
|
|
<point x="594.209412" y="247.953018"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n0::n3">
|
|
<data key="dName">finish_turn</data>
|
|
<data key="dData">entry/
|
|
complete_turn()
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="460.462036" y="506.315277" width="267.494720" height="69.211853"/>
|
|
</data>
|
|
</node>
|
|
</graph>
|
|
</node>
|
|
<node id="n0::n1">
|
|
<data key="dName">idle</data>
|
|
<data key="dData">entry/</data>
|
|
<data key="dGeometry">
|
|
<rect x="766.168030" y="103.962479" width="313.216827" height="117.952454"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n2">
|
|
<data key="dName">wait</data>
|
|
<data key="dData">entry/</data>
|
|
<data key="dGeometry">
|
|
<rect x="1102.596069" y="106.936821" width="432.212921" height="640.662781"/>
|
|
</data>
|
|
<graph id="n0::n2:" edgedefault="directed">
|
|
<node id="n0::n2::n0">
|
|
<data key="dName">maintain</data>
|
|
<data key="dData">entry/
|
|
orientation.start_motor(AXIS_Z)
|
|
|
|
exit/
|
|
orientation.stop_motor(AXIS_Z)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="1121.596069" y="320.743958" width="393.600128" height="400.073730"/>
|
|
</data>
|
|
<graph id="n0::n2::n0:" edgedefault="directed">
|
|
<node id="n0::n2::n0::n0">
|
|
<data key="dName">correct_cw</data>
|
|
<data key="dData">entry/
|
|
orientation.set_motor_moment(AXIS_Z, -M)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="1140.349731" y="479.237457" width="358.315155" height="75.337151"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n2::n0::n1">
|
|
<data key="dName">correct_ccw</data>
|
|
<data key="dData">entry/
|
|
orientation.set_motor_moment(AXIS_Z, M)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<rect x="1140.349731" y="624.163330" width="358.315155" height="75.337151"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n2::n0::n2">
|
|
<data key="dVertex">initial</data>
|
|
<data key="dName"></data>
|
|
<data key="dGeometry">
|
|
<point x="1319.507324" y="436.352631"/>
|
|
</data>
|
|
</node>
|
|
</graph>
|
|
</node>
|
|
<node id="n0::n2::n1">
|
|
<data key="dName">static</data>
|
|
<data key="dData">entry/</data>
|
|
<data key="dGeometry">
|
|
<rect x="1122.707275" y="201.438705" width="393.600128" height="75.337151"/>
|
|
</data>
|
|
</node>
|
|
<node id="n0::n2::n2">
|
|
<data key="dVertex">initial</data>
|
|
<data key="dName"></data>
|
|
<data key="dGeometry">
|
|
<point x="1319.507324" y="158.553864"/>
|
|
</data>
|
|
</node>
|
|
</graph>
|
|
</node>
|
|
</graph>
|
|
</node>
|
|
<node id="n1">
|
|
<data key="dVertex">initial</data>
|
|
<data key="dName"></data>
|
|
<data key="dGeometry">
|
|
<point x="945.784363" y="-25.402416"/>
|
|
</data>
|
|
</node>
|
|
<node id="n2">
|
|
<data key="dNote">informal</data>
|
|
<data key="dData">Init scripts:
|
|
|
|
test3sm_constants.py
|
|
test3sm_orient.py</data>
|
|
<data key="dGeometry">
|
|
<rect x="445.462036" y="652.554016" width="160.084412" height="95.045609"/>
|
|
</data>
|
|
</node>
|
|
<edge id="e0" source="n1" target="n0::n1">
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="23.007910" y="-7.047745"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="e1" source="n0" target="n0::n1">
|
|
<data key="dData">STOP/</data>
|
|
<data key="dGeometry">
|
|
<point x="826.770386" y="-4.951387"/>
|
|
<point x="918.657471" y="-4.951387"/>
|
|
</data>
|
|
<data key="dSourcePoint">
|
|
<point x="-157.871811" y="-122.809059"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="-4.118959" y="-7.297270"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::e0" source="n0::n1" target="n0::n0">
|
|
<data key="dData">TANGENT(target_a)/
|
|
update_turn_parameters(target_a, 0.0)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<point x="1018.008484" y="374.381714"/>
|
|
</data>
|
|
<data key="dSourcePoint">
|
|
<point x="95.232048" y="21.029173"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="129.207840" y="23.561827"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::e1" source="n0::n1" target="n0::n0">
|
|
<data key="dData">BACK(target_a)/
|
|
update_turn_parameters(target_a, 180.0)
|
|
</data>
|
|
<data key="dGeometry">
|
|
<point x="1036.419922" y="468.787109"/>
|
|
</data>
|
|
<data key="dSourcePoint">
|
|
<point x="113.643471" y="25.929409"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="148.774094" y="117.967224"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n0::e0" source="n0::n0::n2" target="n0::n0::n0">
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n0::e1" source="n0::n0::n0" target="n0::n0::n1">
|
|
<data key="dData">[completed()]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n0::e2" source="n0::n0::n1" target="n0::n0::n3">
|
|
<data key="dData">[completed()]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::e2" source="n0::n2" target="n0::n1">
|
|
<data key="dData">TIME_TICK [orientation_completed()]/
|
|
DISPATCH(cpu, 'ORIENTED')
|
|
DISPATCH(navigation, 'ORIENTED')
|
|
</data>
|
|
<data key="dGeometry">
|
|
<point x="1050.996216" y="526.111328"/>
|
|
</data>
|
|
<data key="dSourcePoint">
|
|
<point x="-216.093536" y="98.843132"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="128.219757" y="13.393255"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::n0::e0" source="n0::n2::n0::n0" target="n0::n2::n0::n1">
|
|
<data key="dData">[orientation.get_angular_velocity(AXIS_Z) < DW]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="-154.388992" y="1.810381"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="-154.388992" y="5.481530"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::n0::e1" source="n0::n2::n0::n1" target="n0::n2::n0::n0">
|
|
<data key="dData">[orientation.get_angular_velocity(AXIS_Z) > DW]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="163.300400" y="-10.020717"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="163.300400" y="1.093013"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::n0::e2" source="n0::n2::n0::n2" target="n0::n2::n0::n0">
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::e0" source="n0::n2::n2" target="n0::n2::n1">
|
|
<data key="dSourcePoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="0.000000" y="0.000000"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::e3" source="n0::n0::n3" target="n0::n2">
|
|
<data key="dData">[completed()]/</data>
|
|
<data key="dGeometry">
|
|
<point x="665.626831" y="711.283508"/>
|
|
</data>
|
|
<data key="dSourcePoint">
|
|
<point x="71.417427" y="14.494992"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="-17.616568" y="284.015320"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::e1" source="n0::n2::n0" target="n0::n2::n1">
|
|
<data key="dData">[is_target_dw()]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="138.107727" y="-80.285820"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="136.996552" y="11.085690"/>
|
|
</data>
|
|
</edge>
|
|
<edge id="n0::n2::e2" source="n0::n2::n1" target="n0::n2::n0">
|
|
<data key="dData">[not is_target_dw()]/</data>
|
|
<data key="dSourcePoint">
|
|
<point x="-136.091248" y="13.453504"/>
|
|
</data>
|
|
<data key="dTargetPoint">
|
|
<point x="-134.980087" y="-169.298065"/>
|
|
</data>
|
|
</edge>
|
|
</graph>
|
|
</graphml>
|