SSBB: How to calculate a FC using a PID?