You should be debugging your code...FRC has instructions for that in one of their manuals. Put printf() statements in your code...I assume you know how to do this. If not,
http://www.learncpp.com is a good place for C++ tutorials and will explain that.
Then, in your Remote Systems window down in the left-hand corner of WR, right click on the cRio, then about halfway up the menu there will be a submenu whose name I cannot remember. It's right under the Reset Target section of the menu. In that submenu there will be a Target Console option. Click that, and you will get the cRio's console. All your printf() statements will go there.
Thanks for the info on the servo class...I'll keep trying =]