Autonomous code 90% done, got second sensor done