Add DanceLed Main, full function.
Next : Set address by dipSW