Update entry.S

update from sc-02 kernel (same philosophy)