Started visualization, first servo working