Update of sensor_sm to include all four sensor states and reply to i2c messages with sensor data