Added joints.m for the joint definitions (readability/modularity).
Added joint constants to some portions.
Small change to controller.