1
1
import unittest
2
- import numpy as np
3
2
import pinocchio as pin
4
- from numpy .testing import assert_almost_equal as assertApprox
3
+ import parameter_server_conf as param_server_conf
4
+ from dynamic_graph .sot .core .parameter_server import ParameterServer
5
+ import sys
6
+ from os .path import dirname , join , abspath
5
7
6
8
# Switch pinocchio to numpy matrix
7
9
pin .switchToNumpyMatrix ()
8
10
9
- import parameter_server_conf as param_server_conf
10
- from dynamic_graph .sot .core .parameter_server import ParameterServer
11
11
12
12
param_server = ParameterServer ("param_server" )
13
13
param_server .init (0.001 , "talos.urdf" , "talos" )
19
19
urdfPath = param_server_conf .urdfFileName
20
20
urdfDir = param_server_conf .model_path
21
21
22
- import sys
23
-
24
- from os .path import dirname , join , abspath
25
-
26
22
27
23
class TestParameterServer (unittest .TestCase ):
28
24
@@ -34,22 +30,26 @@ def test_set_parameter(self):
34
30
35
31
from example_robot_data .path import EXAMPLE_ROBOT_DATA_MODEL_DIR
36
32
37
- urdf_file_name = EXAMPLE_ROBOT_DATA_MODEL_DIR + \
38
- '/talos_data/robots/talos_reduced.urdf'
33
+ urdf_file_name = EXAMPLE_ROBOT_DATA_MODEL_DIR + \
34
+ '/talos_data/robots/talos_reduced.urdf'
39
35
40
36
fs = open (urdf_file_name , 'r' )
41
37
urdf_rrbot_model_string = fs .read ()
42
38
fs .close ()
43
39
44
- param_server .setParameter ("/robot_description" , urdf_rrbot_model_string )
40
+ param_server .setParameter ("/robot_description" ,
41
+ urdf_rrbot_model_string )
45
42
model2_string = param_server .getParameter ("/robot_description" )
46
43
47
44
self .assertEqual (urdf_rrbot_model_string , model2_string )
48
45
49
- aValue = 0.122
50
- param_server .setParameterDbl ("/specificities/feet/right/size/height" ,aValue )
51
- a2Value = param_server .getParameterDbl ("/specificities/feet/right/size/height" )
52
- self .assertEqual (aValue ,a2Value )
53
-
46
+ aValue = 0.122
47
+ param_server .setParameterDbl ("/specificities/feet/right/size/height" ,
48
+ aValue )
49
+ a2Value = param_server .getParameterDbl (
50
+ "/specificities/feet/right/size/height" )
51
+ self .assertEqual (aValue , a2Value )
52
+
53
+
54
54
if __name__ == '__main__' :
55
55
unittest .main ()
0 commit comments