new id code with all functions in one file

still working
Merge pull request #5 from wingprince/master

One program for all functions
Merge remote-tracking branch 'upstream/master'
Update
test
MEHHH

MY
New Arm and fixed shakiness

Fixed shakines