test-jointangle.py
Go to the documentation of this file.
00001 #!/usr/bin/env python
00002 
00003 PKG = 'hrpsys'
00004 NAME = 'test-hostname'
00005 
00006 import imp  ## for rosbuild
00007 try:
00008     imp.find_module(PKG)
00009 except:
00010     import roslib; roslib.load_manifest(PKG)
00011 
00012 
00013 import os
00014 import sys
00015 import time
00016 import unittest
00017 import yaml
00018 
00019 import rostest
00020 from hrpsys import rtm
00021 from hrpsys.hrpsys_config import *
00022 import OpenHRP
00023 
00024 rtm.nsport = 2809
00025 
00026 class PA10(HrpsysConfigurator):
00027     def getRTCList(self):
00028         return [
00029             ['seq', "SequencePlayer"],
00030             ['sh', "StateHolder"],
00031             ['fk', "ForwardKinematics"],
00032             ['log', "DataLogger"],
00033             ]
00034 
00035 
00036 
00037 class TestJointAngle(unittest.TestCase):
00038 
00039     @classmethod
00040     def setUpClass(self):
00041         h = PA10()
00042         h.init(robotname="PA10Controller(Robot)0")
00043 
00044     def test_set_if_find_log(self):
00045         h = PA10()
00046         h.findComps()
00047         print >>sys.stderr, "log=",h.log, "log_svc=",h.log_svc
00048         self.assertTrue(h.log)
00049         self.assertTrue(h.log_svc)
00050 
00051     def test_get_joint_angles(self):
00052         h = PA10()
00053         h.findComps()
00054         print >>sys.stderr,  h.getJointAngles()
00055         self.assertEqual(len(h.getJointAngles()), int(9))
00056 
00057     def test_set_joint_angles(self):
00058         h = PA10()
00059         h.findComps()
00060         self.assertTrue(h.setJointAngles(h.getJointAngles(),1))
00061         self.assertEqual(h.waitInterpolation(), None)
00062 
00063         import random
00064         a = [(360*random.random()-180) for i in xrange(len(h.getJointAngles()))]
00065         self.assertTrue(h.setJointAngles(a,2))
00066         self.assertEqual(h.waitInterpolation(), None)
00067 
00068         a = [0 for i in xrange(len(h.getJointAngles()))]
00069         self.assertTrue(h.setJointAngles(a,2))
00070         self.assertEqual(h.waitInterpolation(), None)
00071 
00072 #unittest.main()
00073 if __name__ == '__main__':
00074     rostest.run(PKG, NAME, TestJointAngle, sys.argv)
00075 
00076 


hrpsys
Author(s): AIST, Fumio Kanehiro
autogenerated on Wed Sep 6 2017 02:35:56