Created a function for controllability reduction, and integrated it to a special version of the IHCT-LQR solver. Starting to update the IHAQR for that.