Implemented forwarding of sensor data to SSP and corrected bugs