Have simulator cpp plotting working
finished pr2_sim/arm.cpp
camera truncation works