fixed init functiuon in pibot_controller#3