derive_everything.m runs error free (takes a couple mins), added simple control law, etc.