calculPositionmat.c