diff_drive: fix unit test
Merge pull request #18 from po1/fix-diff-drive-unit-test

Fix diff drive unit test