Close to working (except distance sensor)