fixed equations friction and rotation almost perfect now