Finally submit, clean enough, moved main to bottom
Finally considered legal and old enough
Creating matrix solver for m-diagonal matrices, up to aumented matrix step