Working temp sensor routine

Also added current sensor detect so slave only reads optional current
sensor if connected.