[Minor] Change matrix initialization
[Minor] Change matrix initialization

aelkhour/pinocchio,fvalenza/pinocchio,aelkhour/pinocchio,aelkhour/pinocchio,fvalenza/pinocchio,aelkhour/pinocchio,fvalenza/pinocchio,fvalenza/pinocchio