I found that the problem is in the saturation. CPU's property "Saturation mode" doesn't help. I use this function together with svmStd function (from SpaceVectorMod bean) where saturation off - SA bit of OMR register is cleared. So if you have the same problem set this bit manually.