Remove unnecessary function motors_velocity_get()
Setup all motors to portB pins

Just need check the order of pins.