If the maximum number is exceeded fail with an informative error message. Fixes #419. Signed-off-by: Jacob Perron <jacob@openrobotics.org>