Why do we include this if we don't throw exceptions? Also, we should probably use moveit/exceptions/