sample closed loop simulation code and lectures #6