More better ifs and guaranteed exact distance

Added if statements that work better when t_accel is not a multiple of MOVE_DURATION.

Last move_cmd_t will contain missing distance instead of 0