Replace Quaternion.Identity by Quaternion((1,0,0),0)

Such constructions in python files are failing when
vectorization is on. Probably because Identity construction
does not return real object (?)
In state pos_set and ori_set use passing by value.

Such construction fails when vectorization is on.