Move empathy code to subdirectory, modify cpp interface to use robotFactory, source format