Currently supports hardmap and elements of softmap

I am freezing this to provide a stable version to people who want to experiment, whilst major works carry on to implement softmap.