Changes project structure.

Create 2 packages: behavior and pmath. Moves spline and geometry to 
pmath and behavior, ankle and hip to behavior. Renames behavior.py
module to walk_forward.py. 
Also turns on gyro work in work_forward behavior.