Added diagnostic information [puts to SmartDashboard] to understand better behavior in targeting.

Also increased current tolerance to 0.25.