Figure 4: Structure diagram of SHAPF control system.