preparing for merge with raspberry pi. added percentDrive

Added functionality that uses sodar (only the middle one until L/R detection is added) to find what percentage distance it is away from the optimal point. This allows a speed to catch up / move back depending on how close/far it currently is