Int stable

Since we use millisecond to control the motors' behaviors, there is no need to use double, int is more convenience.