Multiple bug fixes for MoveitStateAdapter

Added unit test to verify functionality.  Addresses #24.