right_arm_param.xml

<?xml version="1.0" encoding="utf-8"?>
<!--
Copyright (C) 2006 Marcin Kalicinski
Distributed under the Boost Software License, Version 1.0.
See http://www.boost.org/LICENSE_1_0.txt
-->
<SelfCtrlParams>
        <Rlxp>
            <kp>0.01</kp>
            <psm>
                <e00>1</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlxp>
        <Rlyp>
            <kp>0.01</kp>
            <psm>
                <e00>0</e00>
                <e11>1</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlyp>
        <Rlzp>
            <kp>0.01</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlzp>
        <Rrxp>
            <kp>0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>1</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rrxp>
        <Rryp>
            <kp>0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>1</e44>
                <e55>0</e55>
            </psm>
        </Rryp>
        <Rrzp>
            <kp>0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </psm>
        </Rrzp>
        <Rlxn>
            <kp>-0.01</kp>
            <psm>
                <e00>1</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlxn>
        <Rlyn>
            <kp>-0.01</kp>
            <psm>
                <e00>0</e00>
                <e11>1</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlyn>
        <Rlzn>
            <kp>-0.01</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlzn>
        <Rrxn>
            <kp>-0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>1</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rrxn>
        <Rryn>
            <kp>-0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>1</e44>
                <e55>0</e55>
            </psm>
        </Rryn>
        <Rrzn>
            <kp>-0.05</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </psm>
        </Rrzn>
        <Rno>
            <kp>0</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rno>
	<Rlf>
            <kp>0</kp>
            <psm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </psm>
        </Rlf>
        <Rrf>
            <kp>0</kp>
            <psm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </psm>
        </Rrf>
</SelfCtrlParams>
<AdmittanceParams>
        <ContactPointTracking>
            <x>
                <kp>0.0002</kp>
                <ki>0.000005</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.0002</kp>
                <ki>0.000005</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.0002</kp>
                <ki>0.000005</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </ContactPointTracking>

        <ContactForceTracking>
            <x>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.02</kp>
                <ki>0.000</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </ContactForceTracking>

        <ContactPointForceTracking>
            <x>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.01</kp>
                <ki>0</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </ContactPointForceTracking>
        
        <SensingPoleTracking>
            <x>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.02</kp>
                <ki>0</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>-1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </SensingPoleTracking>

        <ZOrienTracking>
            <x>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0.1</kp>
                <ki>0.00001</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0.03</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0.03</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0.05</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </ZOrienTracking>

        <LineTracking>
            <x>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.0002</kp>
                <ki>0.00003</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0.005</kp>
                <ki>0.0001</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0.03</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0.03</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0.01</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>1</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </LineTracking>

        <CoverObjectSurface>
            <x>
                <kp>0.0001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.0001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.02</kp>
                <ki>0</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0.8</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0.8</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0.01</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>-1</e11>
                <e22>1</e22>
                <e33>-1</e33>
                <e44>1</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </CoverObjectSurface>

        <ObjectSurfaceExploring>
            <x>
                <kp>0.0001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </x>
            <y>
                <kp>0.0001</kp>
                <ki>0</ki>
                <kd>0</kd>
            </y>
            <z>
                <kp>0.01</kp>
                <ki>0</ki>
                <kd>0</kd>
            </z>
            <roll>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll>
            <pitch>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch>
            <yaw>
                <kp>0.0002</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw>
            <roll2>
                <kp>0.8</kp>
                <ki>0</ki>
                <kd>0</kd>
            </roll2>
            <pitch2>
                <kp>0.8</kp>
                <ki>0</ki>
                <kd>0</kd>
            </pitch2>
            <yaw2>
                <kp>0.01</kp>
                <ki>0</ki>
                <kd>0</kd>
            </yaw2>
            <tsm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>0</e55>
            </tsm>
            <vsm>
                <e00>0</e00>
                <e11>0</e11>
                <e22>0</e22>
                <e33>0</e33>
                <e44>0</e44>
                <e55>0</e55>
            </vsm>
            <ttjkm>
                <e00>1</e00>
                <e11>-1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>-1</e44>
                <e55>0</e55>
            </ttjkm>
            <vtjkm>
                <e00>1</e00>
                <e11>1</e11>
                <e22>1</e22>
                <e33>1</e33>
                <e44>1</e44>
                <e55>1</e55>
            </vtjkm>
        </ObjectSurfaceExploring>

</AdmittanceParams>

<StiffnessParams>
	<stiffness>
		<a1>500</a1>
		<a2>500</a2>
		<e1>500</e1>
		<a3>500</a3>
		<a4>500</a4>
		<a5>500</a5>
		<a6>500</a6>
	</stiffness>
	<damping>
		<a1>0.3</a1>
		<a2>0.3</a2>
		<e1>0.3</e1>
		<a3>0.3</a3>
		<a4>0.3</a4>
		<a5>0.3</a5>
		<a6>0.3</a6>
	</damping>
</StiffnessParams>