Use PositionJointInterface instead of effort, as the later makes the arm
explode (literally!)
Provide meaningful values for links' moment of inertia, but just epsilon
values.
The right formulas are explained here:
http://en.wikipedia.org/wiki/List_of_moments_of_inertia