fixed a whole lot more bugs
autopep8 and realized jump terms go into linear system not inside the LQ's b variable