Fix toroplus GPS issue

Change-Id: Iaf9cc9e08e66ec80697808167a4a2afd6b126c31