Add block diagram for position control