- Timestamp:
- Jul 7, 2021, 2:12:52 PM (3 years ago)
- Location:
- trunk/demos/TwoWheelRobotCircleFollower/ugv
- Files:
-
- 2 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/demos/TwoWheelRobotCircleFollower/ugv/resources/core2-64/setup_sumo.xml
r378 r430 15 15 <Tab name="Reglages"> 16 16 <GroupBox name="post rotation 1"> 17 <DoubleSpinBox name="value" value=" 0"/>18 <ComboBox name="axis" value=" 0"/>17 <DoubleSpinBox name="value" value="90"/> 18 <ComboBox name="axis" value="1"/> 19 19 </GroupBox> 20 20 <GroupBox name="post rotation 2"> 21 <DoubleSpinBox name="value" value=" 0"/>21 <DoubleSpinBox name="value" value="90"/> 22 22 <ComboBox name="axis" value="0"/> 23 23 </GroupBox> 24 24 <GroupBox name="ugv_0 Passe bas"> 25 <DoubleSpinBox name="period, 0 for auto" value="0 "/>26 <DoubleSpinBox name="cutoff frequency" value=" 1"/>25 <DoubleSpinBox name="period, 0 for auto" value="0.01"/> 26 <DoubleSpinBox name="cutoff frequency" value="2"/> 27 27 </GroupBox> 28 28 <GroupBox name="ugv_0_euler"> 29 <DoubleSpinBox name="period, 0 for auto:" value="0 "/>29 <DoubleSpinBox name="period, 0 for auto:" value="0.01"/> 30 30 <DoubleSpinBox name="saturation, -1 to disable:" value="-1"/> 31 31 </GroupBox> 32 32 <GroupBox name="target Passe bas"> 33 <DoubleSpinBox name="period, 0 for auto" value="0 "/>34 <DoubleSpinBox name="cutoff frequency" value=" 1"/>33 <DoubleSpinBox name="period, 0 for auto" value="0.01"/> 34 <DoubleSpinBox name="cutoff frequency" value="2"/> 35 35 </GroupBox> 36 36 <GroupBox name="target_euler"> 37 <DoubleSpinBox name="period, 0 for auto:" value="0 "/>37 <DoubleSpinBox name="period, 0 for auto:" value="0.01"/> 38 38 <DoubleSpinBox name="saturation, -1 to disable:" value="-1"/> 39 39 </GroupBox> 40 40 <GroupBox name="circle"> 41 41 <DoubleSpinBox name="period, 0 for auto" value="0"/> 42 <DoubleSpinBox name="R" value=" 0"/>43 <DoubleSpinBox name="velocity" value=" 0"/>44 <DoubleSpinBox name="acceleration (absolute)" value="0 "/>42 <DoubleSpinBox name="R" value="2"/> 43 <DoubleSpinBox name="velocity" value="1.0"/> 44 <DoubleSpinBox name="acceleration (absolute)" value="0.2"/> 45 45 </GroupBox> 46 46 </Tab> 47 47 <Tab name="Mesures ugv_0"> 48 48 <DataPlot1D name="x" period="100" enabled="1"/> 49 <DataPlot1D name="y" period="100" enabled=" 0"/>49 <DataPlot1D name="y" period="100" enabled="1"/> 50 50 <DataPlot1D name="z" period="100" enabled="0"/> 51 <DataPlot1D name="vx" period="100" enabled=" 0"/>52 <DataPlot1D name="vy" period="100" enabled=" 0"/>51 <DataPlot1D name="vx" period="100" enabled="1"/> 52 <DataPlot1D name="vy" period="100" enabled="1"/> 53 53 <DataPlot1D name="vz" period="100" enabled="0"/> 54 54 </Tab> … … 72 72 <GridLayout name="buttons"> 73 73 <PushButton name="kill"/> 74 <PushButton name="start_circle" />75 <PushButton name="stop_circle" />74 <PushButton name="start_circle" value="1"/> 75 <PushButton name="stop_circle" value="1"/> 76 76 </GridLayout> 77 77 </Tab> 78 < /TabWidget>78 <Tab name="control laws"><TabWidget name="laws"><Tab name="Setup"><GroupBox name="u_x"><DoubleSpinBox name="period, 0 for auto" value="0"/><DoubleSpinBox name="kp:" value="0.2"/><DoubleSpinBox name="ki:" value="0"/><DoubleSpinBox name="sat i:" value="0"/><DoubleSpinBox name="kd:" value="0.0008"/><DoubleSpinBox name="sat:" value="1"/></GroupBox><GroupBox name="u_y"><DoubleSpinBox name="period, 0 for auto" value="0"/><DoubleSpinBox name="kp:" value="0.2"/><DoubleSpinBox name="ki:" value="0"/><DoubleSpinBox name="sat i:" value="0"/><DoubleSpinBox name="kd:" value="0.0008"/><DoubleSpinBox name="sat:" value="1"/></GroupBox><DoubleSpinBox name="L" value="0.8"/></Tab><Tab name="Graphes"><DataPlot1D name="u_x" period="100" enabled="0"/><DataPlot1D name="u_y" period="100" enabled="0"/></Tab></TabWidget></Tab></TabWidget> 79 79 <PushButton name="save config on target (ugv_0)" value="1"/> 80 80 </root> -
trunk/demos/TwoWheelRobotCircleFollower/ugv/src/CircleFollower.cpp
r389 r430 182 182 ugvVrpn->GetQuaternion(vrpnQuaternion); 183 183 float yaw=vrpnQuaternion.ToEuler().yaw; 184 float L=1;185 184 float v= cosf(yaw)*uX->Output() + sinf(yaw)*uY->Output(); 186 185 float w = -sinf(yaw)/l->Value()*uX->Output() + cosf(yaw)/l->Value()*uY->Output();
Note:
See TracChangeset
for help on using the changeset viewer.