Recommitting some code to get the update

This commit adds the basic casting model motions
Still trying to commit correct files

Updating old, already synced files.
Merge branch 'master' of https://github.com/LRAMproto/ArmCode
Merge branch 'master' of https://github.com/LRAMproto/ArmCode