从Pepper机器人获取图像并显示

# /usr/bin/python2 
# -*-coding: utf-8 -*-

import numpy as np
def decodeImage(data):
        if data:
            imageWidth = data[0]
            imageHeight = data[1]
            imageLayers = data[2]
            imageArray = data[6]
            imageArray = np.array(bytearray(imageArray))
            im = imageArray.reshape([imageHeight, imageWidth, imageLayers])
            return np.array(im)
        return None
def main():
    from naoqi import ALProxy
    import cv2
    robotIP = "192.168.0.1"
    port = 9559
    vision = ALProxy("ALVideoDevice",robotIP, port)
    while 1 :
        ImageData = vision.getImageRemote("FrameGetter/Camera_1")
        Image = decodeImage(ImageData)
        cv2.imshow("Image",Image)
        k = cv2.waitKey(1)
        if k == ord("q"):
            break

if __name__ == "__main__":
    main()