Implemented current sense reading in motor driver library

It's untested and uncalibrated but should function