finalizing

This commit is contained in:
Pavel Lutskov
2019-02-10 17:33:26 +01:00
parent 567f7b0274
commit 1a65bb6af7
7 changed files with 95 additions and 33 deletions

View File

@@ -1,4 +1,6 @@
#! /usr/bin/env python
from __future__ import division
import os
import json
from time import sleep
@@ -60,6 +62,7 @@ if __name__ == '__main__':
rospy.wait_for_service('inform_masterloop')
ll = tf.TransformListener()
mp.setMoveArmsEnabled(False, False)
mp.setAngles(('HeadYaw', 'HeadPitch'), (0.0, 0.35), 0.3)
while not rospy.is_shutdown():
sleep(0.3)
@@ -101,6 +104,7 @@ if __name__ == '__main__':
if not permission:
mp.stopMove()
else:
mp.setAngles(('HeadYaw', 'HeadPitch'), (0.0, 0.35), 0.3)
mp.moveToward(*movement) # DON'T DELETE THIS ONE
pass