Add PrevewController testing and update plotting

(irteus-demo.l, walk-motion.l) : Add PrevewController testing and update plotting