added gyroscope measurement control may need raw angular velocity
added 4 motor init in arduino side in PWM_TEST