Added PID control and E axis