modulized the drive code.
moving towards coding for autonomous