warning:angular velocity has to be multiply by 2