Assignment 1_Exercise 7 - Adding First Order Control