Refactoring of arm code. Conveinience methods added and debugged
Modification of distance sensor code to respect correct points of reference