Fig Inverted Pendulum Free Body Diagram