NVIC priority change

Use 'better' macros to handle priority. This simplifies passing priority to function and new ATOMIC_BLOCK macro