altered .c sol file to do file input and output rather than through cmd
line.
wrote and debugged gen_init_state as much as possible.
Wrote main.py as much as possible. mock script with timing can be run.
still need to add servo manipulation code. Then we're done!