How to use the condition.AbsolutePositionCondition function in condition
To help you get started, we’ve selected a few condition examples, based on popular ways it is used in public projects.
Secure your code as it's written. Use Snyk Code to scan source code in minutes - no build needed - and fix issues immediately.
jhu-lcsr / costar_plan / costar_task_plan / python / costar_task_plan / simulation / option.py View on Github 
def samplePolicy(self, world):
return CartesianMotionPolicy(self.position,
self.rotation,
goal=None), \
AbsolutePositionCondition(
self.position, # where we want to grab it
self.rotation,
# rotation with which we want to grab it
self.position_tolerance,
self.rotation_tolerance,
)self.rotation,
# rotation with which we want to grab it
self.position_tolerance,
self.rotation_tolerance)
else:
obj = world.getObject(self.goal)
pg = kdl.Vector(*self.position)
Rg = kdl.Rotation.Quaternion(*self.rotation)
Tg = kdl.Frame(Rg, pg)
T = obj.state.T * Tg
position = list(T.p)
rotation = list(T.M.GetQuaternion())
return CartesianMotionPolicy(position,
rotation,
goal=None), \
AbsolutePositionCondition(
position, # where we want to grab it
rotation, # rotation with which we want to grab it
self.position_tolerance,
self.rotation_tolerance,)condition
A user friendly way to construct conditions for pandas dataframe query and sql
MIT
Latest version published 4 years ago