Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017 import traceback
00018 import sys
00019 from omniORB import CORBA
00020
00021 import RTC
00022 import OpenRTM_aist
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041 class PortAdmin:
00042 """
00043 """
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054 class comp_op:
00055 def __init__(self, name=None, factory=None):
00056 if name:
00057 self._name = name
00058 if factory:
00059 self._name = factory.getProfile().name
00060
00061 def __call__(self, obj):
00062 name_ = obj.getProfile().name
00063 return self._name == name_
00064
00065
00066
00067
00068
00069
00070
00071
00072 class find_port_name:
00073 def __init__(self, name):
00074 self._name = name
00075
00076 def __call__(self, p):
00077 prof = p.get_port_profile()
00078 name_ = prof.name
00079 return self._name == name_
00080
00081
00082
00083
00084
00085
00086
00087
00088 class del_port:
00089 def __init__(self, pa):
00090 self._pa = pa
00091 return
00092
00093 def __call__(self, p):
00094 self._pa.deletePort(p)
00095
00096
00097 class find_port:
00098
00099 def __init__(self, p):
00100 self._port = p
00101
00102
00103 def __call__(self, p):
00104 return self._port._is_equivalent(p)
00105
00106
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120 def __init__(self, orb, poa):
00121
00122 self._orb = orb
00123
00124
00125 self._poa = poa
00126
00127
00128 self._portRefs = []
00129
00130
00131 self._portServants = OpenRTM_aist.ObjectManager(self.comp_op)
00132
00133 self._rtcout = OpenRTM_aist.Manager.instance().getLogbuf("PortAdmin")
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153
00154
00155
00156 def getPortServiceList(self):
00157 return self._portRefs
00158
00159
00160
00161
00162
00163
00164
00165
00166
00167
00168
00169
00170
00171
00172
00173
00174
00175
00176
00177
00178
00179
00180 def getPortProfileList(self):
00181 ret = []
00182 for p in self._portRefs:
00183 ret.append(p.get_port_profile())
00184
00185 return ret
00186
00187
00188
00189
00190
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204
00205
00206
00207
00208
00209
00210
00211
00212
00213
00214 def getPortRef(self, port_name):
00215 index = OpenRTM_aist.CORBA_SeqUtil.find(self._portRefs, self.find_port_name(port_name))
00216 if index >= 0:
00217 return self._portRefs[index]
00218 return None
00219
00220
00221
00222
00223
00224
00225
00226
00227
00228
00229
00230
00231
00232
00233
00234
00235
00236
00237
00238
00239
00240
00241
00242
00243
00244
00245
00246
00247 def getPort(self, port_name):
00248 return self._portServants.find(port_name)
00249
00250
00251
00252
00253
00254
00255
00256
00257
00258
00259
00260
00261
00262
00263
00264
00265
00266
00267
00268
00269
00270
00271
00272
00273
00274
00275
00276 def registerPort(self, port):
00277 if not self.addPort(port):
00278 self._rtcout.RTC_ERROR("registerPort() failed.")
00279 return
00280
00281
00282
00283
00284
00285
00286
00287
00288 def addPort(self, port):
00289 if isinstance(port, RTC._objref_PortService):
00290 index = OpenRTM_aist.CORBA_SeqUtil.find(self._portRefs,
00291 self.find_port_name(port.get_port_profile().name))
00292 if index >= 0:
00293 return False
00294 self._portRefs.append(port)
00295 return True
00296 else:
00297 index = OpenRTM_aist.CORBA_SeqUtil.find(self._portRefs,
00298 self.find_port_name(port.getName()))
00299 if index >= 0:
00300 return False
00301 self._portRefs.append(port.getPortRef())
00302 return self._portServants.registerObject(port)
00303 return False
00304
00305
00306
00307
00308
00309
00310
00311
00312
00313
00314
00315
00316
00317
00318
00319
00320
00321
00322
00323
00324
00325
00326
00327
00328
00329
00330
00331
00332
00333
00334 def deletePort(self, port):
00335 if not self.removePort(port):
00336 self._rtcout.RTC_ERROR("deletePort(PortBase&) failed.")
00337 return
00338
00339
00340 def removePort(self, port):
00341 try:
00342 if isinstance(port,RTC._objref_PortService):
00343 OpenRTM_aist.CORBA_SeqUtil.erase_if(self._portRefs, self.find_port(port))
00344 return True
00345
00346 port.disconnect_all()
00347 tmp = port.getProfile().name
00348 OpenRTM_aist.CORBA_SeqUtil.erase_if(self._portRefs, self.find_port_name(tmp))
00349
00350 self._poa.deactivate_object(self._poa.servant_to_id(port))
00351 port.setPortRef(RTC.PortService._nil)
00352
00353 if not self._portServants.unregisterObject(tmp):
00354 return False
00355 return True
00356 except:
00357 self._rtcout.RTC_ERROR(OpenRTM_aist.Logger.print_exception())
00358 return False
00359
00360
00361
00362
00363
00364
00365
00366
00367
00368
00369
00370
00371
00372
00373
00374
00375
00376
00377
00378
00379
00380
00381
00382
00383
00384 def deletePortByName(self, port_name):
00385 if not port_name:
00386 return
00387
00388 p = self._portServants.find(port_name)
00389 self.removePort(p)
00390 return
00391
00392
00393
00394
00395
00396
00397
00398
00399
00400 def activatePorts(self):
00401 ports = self._portServants.getObjects()
00402 for port in ports:
00403 port.activateInterfaces()
00404
00405 return
00406
00407
00408
00409
00410
00411
00412
00413
00414
00415 def deactivatePorts(self):
00416 ports = self._portServants.getObjects()
00417 for port in ports:
00418 port.deactivateInterfaces()
00419
00420 return
00421
00422
00423
00424
00425
00426
00427
00428
00429
00430
00431
00432
00433
00434
00435
00436
00437
00438
00439
00440
00441 def finalizePorts(self):
00442 self.deactivatePorts()
00443 ports = []
00444 ports = self._portServants.getObjects()
00445 len_ = len(ports)
00446 for i in range(len_):
00447 idx = (len_ - 1) - i
00448 self.removePort(ports[idx])