Add format script
Auto-format all source code with clang-format