introduced higher level PID for angles

new angle estimation code has been tested
damn project files

<_>
using an IDE with git for windows is just blowing my mind, I hope this works