Update two functions in the kinematics.c

[DavidLin1577]

1.For further expansion, use switch(x) {...} instead of if(x){...}else if(y){...} in kinematics_create(); 2.Replace for() with rt_memcpy in functionkinematics_get_rpm().