More deeply integrate vision / drive into the framework

[fruzyna]

Right now most of the hard (and redundant) work of these subsystems effectively lives here as sample code. We should find a way to properly incorporate them.