Fixed all bugs and Robot is working as intended.