Prismatic Fix

Simplified Prismatic Joint into a more consolidated representation.
Minor bug fixes for sample code