controller: added formation_test

Signed-off-by: Corey Powell <mistdragon100@gmail.com>