Add filtered lego bot depth align
Merge pull request #2 from Clemensius/master

small driving improvements
Make ticks per mm to be per wheel