probably final, motor parameters may be a bit off