You know you're overdosed on FIRST when you see the thread titled "team 228 can and bottle drive" and think "what kind of crazy drivetrain is that?" - Joe G. [more]
Could you explain what these problems are? There's sample code for both of your questions here, but if there are any questions you have about it, I can answer them.