Implement GuardEntityFSM and its required states and support more debug draw helpers along with some bug fixes

Signed-off-by: MHesham <mhesham.fcis@gmail.com>