Map values from PID

Balancing works better with mapping.