Build PID control and success grab by camera for the first time