Almost ready for a little demo this afternoon: visualization of
internal obstavoid state, and tweaked parameters and PD behavior
(scaling the resulting command by an activation level... not the
cleanest solution, but not too shabby either).