Lagt till PID för höjd