preliminary implementation of FMU with ESC setup