def changeBodyOrientation(self, orientation):
if(orientation == "init"):
self.bodyOrientation = "init"
self.naoCameraHeight = 50
config.walkPoseInit(self.motionProxy)
elif(orientation == "knee"):
self.bodyOrientation = "knee"
self.naoCameraHeight = 41
config.calibrationPoseInit(self.motionProxy)
elif(orientation == "zero"):
self.bodyOrientation = "zero"
self.naoCameraHeight = 52
config.poseZero(self.motionProxy)
def main():
n = NAOCalibration()
config.walkPoseInit(n.motionProxy)
config.calibrationPoseInit(n.motionProxy)
n.performCalibration(0) # search for red nxt
# print "------------------------------------------"
# n.performCalibration(1) #search for green nxt
# print "------------------------------------------"
# n.performCalibration(2) #search for blue nxt
# config.walkPoseInit(n.motionProxy)
sys.exit(1)