Geometric control of an under-actuated balancing robot