void commit_discard_idcache(void)
{
    DEVID &= ~(1<<31);
    /* invalidate cache way 0 */
    cache_invalidate_way(0);

    /* invalidate cache way 1 */
    cache_invalidate_way(1);
    DEVID |= 1<<31;
}

void commit_discard_idcache(void)
{
    asm volatile ("nop \n nop \n");
    asm volatile ("nop \n nop \n");
    /* invalidate cache way 0 */
    cache_invalidate_way(0);

    /* invalidate cache way 1 */
    cache_invalidate_way(1);
    asm volatile ("nop \n nop \n");
    asm volatile ("nop \n nop \n");
}