Arduino Pid Code Without Library, hello, this is my first post here and I hope someone can help me.