Added min/max values for all control variables
Added a very basic P controller for thrust