c++ beams works. takes 30ms
added pr2-sim
moved camera to pr2-sim
rearranged files
working on pr2 system