Fixed issue #1478, #1599, #1709,

 also fixed motors being opposite, updated turning algorithm