Increased pyNMPC speed by factor 10 pythonicly