Copter: Fixed bug in battery current integration

Take two. This one is tested and is very accurate.