add speed regulation
fix direction of the first motor