Fixes for 2D-model collision sensor

Also TwoDModelConfigurer moved to TwoDRobotModel.