Added new world with two walls. Updated coman with initial configuration.
Updated coman dynamic/kinematic model with new joint