Revision e3691d2d
| client/python/hlrc_client/MiddlewareRSB.py | ||
|---|---|---|
| 44 | 44 |
"""initialise |
| 45 | 45 |
:param scope: base scope we want to listen on |
| 46 | 46 |
""" |
| 47 |
#init base settings |
|
| 48 |
Middleware.__init__(self,scope,loglevel)
|
|
| 47 |
# init base settings
|
|
| 48 |
Middleware.__init__(self, scope, loglevel)
|
|
| 49 | 49 |
#call mw init |
| 50 | 50 |
self.init_middleware() |
| 51 | 51 |
|
| ... | ... | |
| 58 | 58 |
def init_middleware(self): |
| 59 | 59 |
"""initialise middleware |
| 60 | 60 |
""" |
| 61 |
#mute rsb logging: |
|
| 61 |
# mute rsb logging:
|
|
| 62 | 62 |
logging.getLogger("rsb").setLevel(logging.ERROR)
|
| 63 | 63 |
|
| 64 | 64 |
#initialise RSB stuff |
| 65 |
self.logger.info("initialising RSB middleware connection on scope %s, registering rst converters..." % (self.base_scope))
|
|
| 65 |
self.logger.info( |
|
| 66 |
"initialising RSB middleware connection on scope %s, registering rst converters..." % (self.base_scope)) |
|
| 66 | 67 |
|
| 67 |
self.EmotionExpression_converter = rsb.converter.ProtocolBufferConverter(messageClass = EmotionExpression)
|
|
| 68 |
self.EmotionExpression_converter = rsb.converter.ProtocolBufferConverter(messageClass=EmotionExpression)
|
|
| 68 | 69 |
rsb.converter.registerGlobalConverter(self.EmotionExpression_converter) |
| 69 | 70 |
|
| 70 |
self.HeadAnimation_converter = rsb.converter.ProtocolBufferConverter(messageClass = HeadAnimation)
|
|
| 71 |
self.HeadAnimation_converter = rsb.converter.ProtocolBufferConverter(messageClass=HeadAnimation)
|
|
| 71 | 72 |
rsb.converter.registerGlobalConverter(self.HeadAnimation_converter) |
| 72 | 73 |
|
| 73 |
self.BinocularHeadGaze_converter = rsb.converter.ProtocolBufferConverter(messageClass = BinocularHeadGaze)
|
|
| 74 |
self.BinocularHeadGaze_converter = rsb.converter.ProtocolBufferConverter(messageClass=BinocularHeadGaze)
|
|
| 74 | 75 |
rsb.converter.registerGlobalConverter(self.BinocularHeadGaze_converter) |
| 75 | 76 |
|
| 76 | 77 |
try: |
| ... | ... | |
| 88 | 89 |
:param blocking: True if this call should block until execution finished on robot |
| 89 | 90 |
""" |
| 90 | 91 |
|
| 91 |
#create emotion & fill it with values: |
|
| 92 |
# create emotion & fill it with values:
|
|
| 92 | 93 |
rsb_em = EmotionExpression() |
| 93 | 94 |
|
| 94 | 95 |
#set value |
| ... | ... | |
| 114 | 115 |
else: |
| 115 | 116 |
future = server.currentEmotion.async(rsb_em) |
| 116 | 117 |
|
| 117 |
#we could block here for a incoming result with a timeout in s |
|
| 118 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
|
| 118 |
#we could block here for a incoming result with a timeout in s
|
|
| 119 |
#print '> server reply: "%s"' % future.get(timeout = 10);
|
|
| 119 | 120 |
self.logger.debug("emotion rpc done")
|
| 120 | 121 |
|
| 121 | 122 |
def publish_head_HeadAnimation(self, HeadAnimation, blocking): |
| ... | ... | |
| 126 | 127 |
|
| 127 | 128 |
self.logger.debug("calling the HeadAnimation rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
| 128 | 129 |
|
| 129 |
#create HeadAnimation & fill it with values: |
|
| 130 |
# create HeadAnimation & fill it with values:
|
|
| 130 | 131 |
rsb_ani = HeadAnimation() |
| 131 | 132 |
|
| 132 | 133 |
#select ani |
| 133 | 134 |
rsb_ani.target = self.convert_HeadAnimationtype_to_rsbval(HeadAnimation.value) |
| 134 | 135 |
rsb_ani.repetitions = HeadAnimation.repetitions |
| 135 | 136 |
rsb_ani.duration_each = HeadAnimation.time_ms |
| 136 |
rsb_ani.scale = HeadAnimation.scale
|
|
| 137 |
rsb_ani.scale = HeadAnimation.scale |
|
| 137 | 138 |
|
| 138 | 139 |
if (blocking): |
| 139 | 140 |
#blocking: |
| ... | ... | |
| 159 | 160 |
""" |
| 160 | 161 |
self.logger.debug("calling the gaze rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
| 161 | 162 |
|
| 162 |
#create gaze target & fill it with values: |
|
| 163 |
# create gaze target & fill it with values:
|
|
| 163 | 164 |
rsb_gaze = BinocularHeadGaze() |
| 164 | 165 |
|
| 165 | 166 |
#fill proto |
| 166 |
rsb_gaze.target = SphericalDirectionFloat()
|
|
| 167 |
rsb_gaze.target.elevation = gaze.tilt
|
|
| 168 |
rsb_gaze.target.azimuth = gaze.pan
|
|
| 167 |
rsb_gaze.target = SphericalDirectionFloat()
|
|
| 168 |
rsb_gaze.target.elevation = gaze.tilt
|
|
| 169 |
rsb_gaze.target.azimuth = gaze.pan
|
|
| 169 | 170 |
|
| 170 | 171 |
rsb_gaze.vergence = gaze.vergence |
| 171 | 172 |
|
| 172 |
|
|
| 173 |
rsb_gaze.offset = SphericalDirectionFloat() |
|
| 174 |
rsb_gaze.offset.elevation = gaze.tilt_offset |
|
| 175 |
rsb_gaze.offset.azimuth = gaze.pan_offset |
|
| 173 |
rsb_gaze.offset = SphericalDirectionFloat() |
|
| 174 |
rsb_gaze.offset.elevation = gaze.tilt_offset |
|
| 175 |
rsb_gaze.offset.azimuth = gaze.pan_offset |
|
| 176 | 176 |
|
| 177 | 177 |
if (blocking): |
| 178 |
#blocking: |
|
| 178 |
# blocking:
|
|
| 179 | 179 |
result = self.server.gaze(rsb_gaze) |
| 180 | 180 |
self.logger.debug("server reply: '%s'" % result)
|
| 181 | 181 |
else: |
| 182 | 182 |
future = self.server.gaze.async(rsb_gaze) |
| 183 |
#we can block here for a incoming result with a timeout in s |
|
| 183 |
# we can block here for a incoming result with a timeout in s
|
|
| 184 | 184 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
| 185 | 185 |
|
| 186 | 186 |
self.logger.debug("gaze rpc done")
|
| 187 | 187 |
|
| 188 |
""" |
|
| 189 |
def publish_mouth_target(self, mouth, blocking): |
|
| 190 |
publish a mouth target via mw |
|
| 191 |
:param mouth: mouth value to set |
|
| 192 |
:param blocking: True if this call should block until execution finished on robot |
|
| 193 |
|
|
| 194 |
self.logger.debug("calling the mouth rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
|
| 195 |
|
|
| 196 |
#create mouth state & fill it with values: |
|
| 197 |
rsb_mouth = MouthTarget() |
|
| 198 |
|
|
| 199 |
#fill proto |
|
| 200 |
rsb_mouth.opening_left = mouth.opening_left |
|
| 201 |
rsb_mouth.opening_center = mouth.opening_center |
|
| 202 |
rsb_mouth.opening_right = mouth.opening_right |
|
| 203 |
rsb_mouth.position_left = mouth.position_left |
|
| 204 |
rsb_mouth.position_center = mouth.position_center |
|
| 205 |
rsb_mouth.position_right = mouth.position_right |
|
| 188 |
""" |
|
| 189 |
def publish_mouth_target(self, mouth, blocking): |
|
| 190 |
publish a mouth target via mw |
|
| 191 |
:param mouth: mouth value to set |
|
| 192 |
:param blocking: True if this call should block until execution finished on robot |
|
| 193 |
|
|
| 194 |
self.logger.debug("calling the mouth rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
|
| 195 |
|
|
| 196 |
#create mouth state & fill it with values: |
|
| 197 |
rsb_mouth = MouthTarget() |
|
| 198 |
|
|
| 199 |
#fill proto |
|
| 200 |
rsb_mouth.opening_left = mouth.opening_left |
|
| 201 |
rsb_mouth.opening_center = mouth.opening_center |
|
| 202 |
rsb_mouth.opening_right = mouth.opening_right |
|
| 203 |
rsb_mouth.position_left = mouth.position_left |
|
| 204 |
rsb_mouth.position_center = mouth.position_center |
|
| 205 |
rsb_mouth.position_right = mouth.position_right |
|
| 206 |
|
|
| 207 |
if (blocking): |
|
| 208 |
#blocking: |
|
| 209 |
result = self.server.mouth(rsb_mouth) |
|
| 210 |
self.logger.debug("server reply: '%s'" % result)
|
|
| 211 |
else: |
|
| 212 |
future = self.server.mouth.async(rsb_mouth) |
|
| 213 |
#we can block here for a incoming result with a timeout in s |
|
| 214 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
|
| 215 |
|
|
| 216 |
self.logger.debug("mouth rpc done")
|
|
| 217 |
""" |
|
| 206 | 218 |
|
| 207 |
if (blocking): |
|
| 208 |
#blocking: |
|
| 209 |
result = self.server.mouth(rsb_mouth) |
|
| 210 |
self.logger.debug("server reply: '%s'" % result)
|
|
| 211 |
else: |
|
| 212 |
future = self.server.mouth.async(rsb_mouth) |
|
| 213 |
#we can block here for a incoming result with a timeout in s |
|
| 214 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
|
| 215 | 219 |
|
| 216 |
self.logger.debug("mouth rpc done")
|
|
| 220 |
def publish_speech(self, text, blocking): |
|
| 221 |
"""publish a tts request via mw |
|
| 222 |
:param text: text to synthesize and speak |
|
| 223 |
:param blocking: True if this call should block until execution finished on robot |
|
| 217 | 224 |
""" |
| 225 |
self.logger.debug("calling the speech rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
|
| 218 | 226 |
|
| 219 |
def publish_speech(self, text, blocking): |
|
| 220 |
"""publish a tts request via mw |
|
| 221 |
:param text: text to synthesize and speak |
|
| 222 |
:param blocking: True if this call should block until execution finished on robot |
|
| 223 |
""" |
|
| 224 |
self.logger.debug("calling the speech rpc (%s)..." % ("BLOCKING" if blocking else "NON-BLOCKING"))
|
|
| 227 |
if (blocking): |
|
| 228 |
# blocking: |
|
| 229 |
result = self.server.speech(text) |
|
| 230 |
self.logger.debug("server reply: '%s'" % result)
|
|
| 231 |
else: |
|
| 232 |
future = self.server.speech.async(text) |
|
| 233 |
# we can block here for a incoming result with a timeout in s |
|
| 234 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
|
| 225 | 235 |
|
| 226 |
if (blocking): |
|
| 227 |
#blocking: |
|
| 228 |
result = self.server.speech(text) |
|
| 229 |
self.logger.debug("server reply: '%s'" % result)
|
|
| 230 |
else: |
|
| 231 |
future = self.server.speech.async(text) |
|
| 232 |
#we can block here for a incoming result with a timeout in s |
|
| 233 |
#print '> server reply: "%s"' % future.get(timeout = 10); |
|
| 236 |
self.logger.debug("speech rpc done")
|
|
| 234 | 237 |
|
| 235 |
self.logger.debug("speech rpc done")
|
|
| 236 |
####################################################################### |
|
| 237 |
def is_running(self): |
|
| 238 |
return True |
|
| 239 | 238 |
|
| 240 |
####################################################################### |
|
| 241 |
# some helpers |
|
| 242 |
def convert_HeadAnimationtype_to_rsbval(self, value): |
|
| 243 |
"""convert RobotHeadAnimation.value to RSB HeadAnimation value |
|
| 244 |
:param value: RobotHeadAnimation.* id to convert to rsb id |
|
| 245 |
""" |
|
| 246 |
#NOTE: this convertion is important as the actual integer values of |
|
| 247 |
# thy python api and the protobuf might be different |
|
| 248 |
|
|
| 249 |
if (value == RobotHeadAnimation.IDLE): |
|
| 250 |
return HeadAnimation().IDLE |
|
| 251 |
elif (value == RobotHeadAnimation.HEAD_NOD): |
|
| 252 |
return HeadAnimation().HEAD_NOD |
|
| 253 |
elif (value == RobotHeadAnimation.HEAD_SHAKE): |
|
| 254 |
return HeadAnimation().HEAD_SHAKE |
|
| 255 |
elif (value == RobotHeadAnimation.EYEBLINK_L): |
|
| 256 |
return HeadAnimation().EYEBLINK_L |
|
| 257 |
elif (value == RobotHeadAnimation.EYEBLINK_R): |
|
| 258 |
return HeadAnimation().EYEBLINK_R |
|
| 259 |
elif (value == RobotHeadAnimation.EYEBLINK_BOTH): |
|
| 260 |
return HeadAnimation().EYEBLINK_BOTH |
|
| 261 |
elif (value == RobotHeadAnimation.EYEBROWS_RAISE): |
|
| 262 |
return HeadAnimation().EYEBROWS_RAISE |
|
| 263 |
elif (value == RobotHeadAnimation.EYEBROWS_LOWER): |
|
| 264 |
return HeadAnimation().EYEBROWS_LOWER |
|
| 265 |
else: |
|
| 266 |
self.logger.error("invalid HeadAnimation type %d\n" % (value))
|
|
| 267 |
return HeadAnimation().NEUTRAL |
|
| 239 |
####################################################################### |
|
| 240 |
def is_running(self): |
|
| 241 |
return True |
|
| 268 | 242 |
|
| 269 |
def convert_emotiontype_to_rsbval(self, value): |
|
| 270 |
"""convert RobotEmotion.value to RSB HeadAnimation value |
|
| 271 |
:param value: RobotEmotion.* id to convert to rsb id |
|
| 272 |
""" |
|
| 273 |
#NOTE: this convertion is important as the actual integer values of |
|
| 274 |
# thy python api and the protobuf might be different |
|
| 275 |
|
|
| 276 |
if (value == RobotEmotion.NEUTRAL): |
|
| 277 |
return EmotionExpression().NEUTRAL |
|
| 278 |
elif (value == RobotEmotion.HAPPY): |
|
| 279 |
return EmotionExpression().HAPPY |
|
| 280 |
elif (value == RobotEmotion.SAD): |
|
| 281 |
return EmotionExpression().SAD |
|
| 282 |
elif (value == RobotEmotion.ANGRY): |
|
| 283 |
return EmotionExpression().ANGRY |
|
| 284 |
elif (value == RobotEmotion.SURPRISED): |
|
| 285 |
return EmotionExpression().SURPRISED |
|
| 286 |
elif (value == RobotEmotion.FEAR): |
|
| 287 |
return EmotionExpression().FEAR |
|
| 288 |
else: |
|
| 289 |
self.logger.error("invalid emotion type %d\n" % (value))
|
|
| 290 |
return EmotionExpression().NEUTRAL |
|
| 243 |
|
|
| 244 |
####################################################################### |
|
| 245 |
# some helpers |
|
| 246 |
def convert_HeadAnimationtype_to_rsbval(self, value): |
|
| 247 |
"""convert RobotHeadAnimation.value to RSB HeadAnimation value |
|
| 248 |
:param value: RobotHeadAnimation.* id to convert to rsb id |
|
| 249 |
""" |
|
| 250 |
# NOTE: this convertion is important as the actual integer values of |
|
| 251 |
# thy python api and the protobuf might be different |
|
| 252 |
|
|
| 253 |
if (value == RobotHeadAnimation.IDLE): |
|
| 254 |
return HeadAnimation().IDLE |
|
| 255 |
elif (value == RobotHeadAnimation.HEAD_NOD): |
|
| 256 |
return HeadAnimation().HEAD_NOD |
|
| 257 |
elif (value == RobotHeadAnimation.HEAD_SHAKE): |
|
| 258 |
return HeadAnimation().HEAD_SHAKE |
|
| 259 |
elif (value == RobotHeadAnimation.EYEBLINK_L): |
|
| 260 |
return HeadAnimation().EYEBLINK_L |
|
| 261 |
elif (value == RobotHeadAnimation.EYEBLINK_R): |
|
| 262 |
return HeadAnimation().EYEBLINK_R |
|
| 263 |
elif (value == RobotHeadAnimation.EYEBLINK_BOTH): |
|
| 264 |
return HeadAnimation().EYEBLINK_BOTH |
|
| 265 |
elif (value == RobotHeadAnimation.EYEBROWS_RAISE): |
|
| 266 |
return HeadAnimation().EYEBROWS_RAISE |
|
| 267 |
elif (value == RobotHeadAnimation.EYEBROWS_LOWER): |
|
| 268 |
return HeadAnimation().EYEBROWS_LOWER |
|
| 269 |
else: |
|
| 270 |
self.logger.error("invalid HeadAnimation type %d\n" % (value))
|
|
| 271 |
return HeadAnimation().NEUTRAL |
|
| 272 |
|
|
| 273 |
|
|
| 274 |
def convert_emotiontype_to_rsbval(self, value): |
|
| 275 |
"""convert RobotEmotion.value to RSB HeadAnimation value |
|
| 276 |
:param value: RobotEmotion.* id to convert to rsb id |
|
| 277 |
""" |
|
| 278 |
# NOTE: this convertion is important as the actual integer values of |
|
| 279 |
# thy python api and the protobuf might be different |
|
| 280 |
|
|
| 281 |
if (value == RobotEmotion.NEUTRAL): |
|
| 282 |
return EmotionExpression().NEUTRAL |
|
| 283 |
elif (value == RobotEmotion.HAPPY): |
|
| 284 |
return EmotionExpression().HAPPY |
|
| 285 |
elif (value == RobotEmotion.SAD): |
|
| 286 |
return EmotionExpression().SAD |
|
| 287 |
elif (value == RobotEmotion.ANGRY): |
|
| 288 |
return EmotionExpression().ANGRY |
|
| 289 |
elif (value == RobotEmotion.SURPRISED): |
|
| 290 |
return EmotionExpression().SURPRISED |
|
| 291 |
elif (value == RobotEmotion.FEAR): |
|
| 292 |
return EmotionExpression().FEAR |
|
| 293 |
else: |
|
| 294 |
self.logger.error("invalid emotion type %d\n" % (value))
|
|
| 295 |
return EmotionExpression().NEUTRAL |
|
Also available in: Unified diff