1. add-step rewritten for significant speed up (N^2 -> N, x2 on 400 step workflow)
2. Added macro 'with-time-elapsed'
3. More debugging messages for profiling
Merge branch 'develop' of github.com:Factual/drake into develop