Change PlanningScene constructor to RobotModelConstPtr

Fixed constructor to more accurately represent the fact that the robot_model_ pointer is const throughout the class. 
You can see in the constructor function that this parameter is used for only assigning to a const ptr. 

This change is also needed for some speed up improvements im working on for PlanningSceneMonitor