First implementation of KKT matrix system for Equally constraint optimization with Newton Step.
Starting point for interior point optimization with feasible starting point.
TODO: infeasible starting point modification to the algorithm