sched_stress: fix matrix inversion routine

Fix code to not go out of bounds of "matrix_1" array
and to do what it's supposed to - calculate inversion matrix.

Signed-off-by: Jan Stancek <jstancek@redhat.com>