Add robot initialization