PID works, bitches. need some params adjustment though