Some changes to iLQG - I don't quite remember what they were....