add pose controller (read poses from files.) Add function to save pdm and pgm images