mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-08-05 06:55:43 +08:00
DevTekVE
176 lines
8.8 KiB
XML
176 lines
8.8 KiB
XML
<?xml version='1.0' encoding='UTF-8'?>
|
|
<root>
|
|
<tabbed_widget parent="main_window" name="Main Window">
|
|
<Tab tab_name="tab1" containers="1">
|
|
<Container>
|
|
<DockSplitter sizes="0.25;0.25;0.25;0.25" count="4" orientation="-">
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="-3.582051" right="1431.113121" top="5.314632" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="Actual lateral accel (roll compensated)" color="#1ac938"/>
|
|
<curve name="Desired lateral accel (roll compensated)" color="#ff7f0e"/>
|
|
<curve name="IMU_LatAccelVal_ms^2" color="#f14cc1"/>
|
|
</plot>
|
|
</DockArea>
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="-3.741271" right="1431.113121" top="3.756006" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="roll compensated lateral acceleration" color="#ff7f0e"/>
|
|
<curve name="IMU_LatAccelVal_Ms^2" color="#1ac938"/>
|
|
<curve name="IMU_LatAccelVal_ms^2_roll_compensated" color="#9467bd"/>
|
|
</plot>
|
|
</DockArea>
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="-0.025000" right="1431.113121" top="1.025000" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="/carState/steeringPressed" color="#0097ff"/>
|
|
<curve name="/carOutput/actuatorsOutput/torque" color="#d62728"/>
|
|
</plot>
|
|
</DockArea>
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="-1.660728" right="1431.113121" top="67.942958" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="/carState/vEgo" color="#f14cc1">
|
|
<transform name="Scale/Offset" alias="/carState/vEgo[Scale/Offset]">
|
|
<options value_scale="2.23694" time_offset="0" value_offset="0"/>
|
|
</transform>
|
|
</curve>
|
|
</plot>
|
|
</DockArea>
|
|
</DockSplitter>
|
|
</Container>
|
|
</Tab>
|
|
<Tab tab_name="tab2" containers="1">
|
|
<Container>
|
|
<DockSplitter sizes="0.5;0.5" count="2" orientation="-">
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="30595.900000" right="1431.113121" top="34884.100000" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="/can/1/IMU_01_10ms/IMU_RollRtVal" color="#17becf"/>
|
|
</plot>
|
|
</DockArea>
|
|
<DockArea name="...">
|
|
<plot flip_x="false" style="Lines" flip_y="false" mode="TimeSeries">
|
|
<range bottom="-0.058795" right="1431.113121" top="0.072448" left="5.322399"/>
|
|
<limitY/>
|
|
<curve name="/liveParameters/roll" color="#bcbd22"/>
|
|
</plot>
|
|
</DockArea>
|
|
</DockSplitter>
|
|
</Container>
|
|
</Tab>
|
|
<currentTabIndex index="1"/>
|
|
</tabbed_widget>
|
|
<use_relative_time_offset enabled="1"/>
|
|
<!-- - - - - - - - - - - - - - - -->
|
|
<!-- - - - - - - - - - - - - - - -->
|
|
<Plugins>
|
|
<plugin ID="DataLoad CSV">
|
|
<default time_axis="" delimiter="0"/>
|
|
</plugin>
|
|
<plugin ID="DataLoad MCAP"/>
|
|
<plugin ID="DataLoad Rlog"/>
|
|
<plugin ID="DataLoad ULog"/>
|
|
<plugin ID="Cereal Subscriber"/>
|
|
<plugin ID="UDP Server"/>
|
|
<plugin ID="WebSocket Server"/>
|
|
<plugin ID="ZMQ Subscriber"/>
|
|
<plugin ID="Fast Fourier Transform"/>
|
|
<plugin ID="Quaternion to RPY"/>
|
|
<plugin ID="Reactive Script Editor">
|
|
<library code="--[[ Helper function to create a series from arrays

 new_series: a series previously created with ScatterXY.new(name)
 prefix: prefix of the timeseries, before the index of the array
 suffix_X: suffix to complete the name of the series containing the X value. If [nil], use the index of the array.
 suffix_Y: suffix to complete the name of the series containing the Y value
 timestamp: usually the tracker_time variable
 
 Example:
 
 Assuming we have multiple series in the form:
 
 /trajectory/node.{X}/position/x
 /trajectory/node.{X}/position/y
 
 where {N} is the index of the array (integer). We can create a reactive series from the array with:
 
 new_series = ScatterXY.new("my_trajectory") 
 CreateSeriesFromArray( new_series, "/trajectory/node", "position/x", "position/y", tracker_time );
--]]

function CreateSeriesFromArray( new_series, prefix, suffix_X, suffix_Y, timestamp )
 
 --- clear previous values
 new_series:clear()
 
 --- Append points to new_series
 index = 0
 while(true) do

 x = index;
 -- if not nil, get the X coordinate from a series
 if suffix_X ~= nil then 
 series_x = TimeseriesView.find( string.format( "%s.%d/%s", prefix, index, suffix_X) )
 if series_x == nil then break end
 x = series_x:atTime(timestamp)	 
 end
 
 series_y = TimeseriesView.find( string.format( "%s.%d/%s", prefix, index, suffix_Y) )
 if series_y == nil then break end 
 y = series_y:atTime(timestamp)
 
 new_series:push_back(x,y)
 index = index+1
 end
end

--[[ Similar to the built-in function GetSeriesNames(), but select only the names with a give prefix. --]]

function GetSeriesNamesByPrefix(prefix)
 -- GetSeriesNames(9 is a built-in function
 all_names = GetSeriesNames()
 filtered_names = {}
 for i, name in ipairs(all_names) do
 -- check the prefix
 if name:find(prefix, 1, #prefix) then
 table.insert(filtered_names, name);
 end
 end
 return filtered_names
end

--[[ Modify an existing series, applying offsets to all their X and Y values

 series: an existing timeseries, obtained with TimeseriesView.find(name)
 delta_x: offset to apply to each x value
 delta_y: offset to apply to each y value 
 
--]]

function ApplyOffsetInPlace(series, delta_x, delta_y)
 -- use C++ indeces, not Lua indeces
 for index=0, series:size()-1 do
 x,y = series:at(index)
 series:set(index, x + delta_x, y + delta_y)
 end
end
"/>
|
|
<scripts/>
|
|
</plugin>
|
|
<plugin ID="CSV Exporter"/>
|
|
</Plugins>
|
|
<!-- - - - - - - - - - - - - - - -->
|
|
<!-- - - - - - - - - - - - - - - -->
|
|
<customMathEquations>
|
|
<snippet name="IMU_LatAccelVal_ms^2">
|
|
<global></global>
|
|
<function>return value * -9.8</function>
|
|
<linked_source>/can/1/IMU_01_10ms/IMU_LatAccelVal</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/steeringPressed</v1>
|
|
<v2>/carControl/latActive</v2>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="roll compensated lateral acceleration">
|
|
<global></global>
|
|
<function>if (v3 == 0 and v4 == 1) then
|
|
return (value * v1 ^ 2) - (v2 * 9.81)
|
|
end
|
|
return 0</function>
|
|
<linked_source>/controlsState/curvature</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/vEgo</v1>
|
|
<v2>/liveParameters/roll</v2>
|
|
<v3>/carState/steeringPressed</v3>
|
|
<v4>/carControl/latActive</v4>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="IMU_LatAccelVal_Ms^2">
|
|
<global></global>
|
|
<function>if (v1 == 0 and v2 == 1) then
|
|
return value * -9.8
|
|
end
|
|
return 0</function>
|
|
<linked_source>/can/1/IMU_01_10ms/IMU_LatAccelVal</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/steeringPressed</v1>
|
|
<v2>/carControl/latActive</v2>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="IMU_LatAccelVal_Ms^3">
|
|
<global></global>
|
|
<function>return value * -9.8</function>
|
|
<linked_source>/can/1/IMU_01_10ms/IMU_LatAccelVal</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/steeringPressed</v1>
|
|
<v2>/carControl/latActive</v2>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="IMU_LatAccelVal_ms^2_roll_compensated">
|
|
<global></global>
|
|
<function>
|
|
|
|
if (v1 == 0 and v2 == 1) then
|
|
return (value * -9.8) - (v3 * 9.81)
|
|
end
|
|
return 0</function>
|
|
<linked_source>/can/1/IMU_01_10ms/IMU_LatAccelVal</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/steeringPressed</v1>
|
|
<v2>/carControl/latActive</v2>
|
|
<v3>/liveParameters/roll</v3>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="Actual lateral accel (roll compensated)">
|
|
<global></global>
|
|
<function>return (value * v1 ^ 2) - (v2 * 9.81)</function>
|
|
<linked_source>/controlsState/curvature</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/vEgo</v1>
|
|
<v2>/liveParameters/roll</v2>
|
|
</additional_sources>
|
|
</snippet>
|
|
<snippet name="Desired lateral accel (roll compensated)">
|
|
<global></global>
|
|
<function>return (value * v1 ^ 2) - (v2 * 9.81)</function>
|
|
<linked_source>/controlsState/desiredCurvature</linked_source>
|
|
<additional_sources>
|
|
<v1>/carState/vEgo</v1>
|
|
<v2>/liveParameters/roll</v2>
|
|
</additional_sources>
|
|
</snippet>
|
|
</customMathEquations>
|
|
<snippets/>
|
|
<!-- - - - - - - - - - - - - - - -->
|
|
</root>
|
|
|