p controller for angle