Revert "Revert "Simplified first_driving_program""

This reverts commit e21911b56fa2c351b2fa1e649c711e7d095aeea6.