read depth image and pose files

matrix to angle needs to be finish