milestone 5c updates. fixed pose duplicate drawing. other methods implemented