about to change forward kinematics

removing matrix transformations; translations only to improve update
speed
partially debugged command schema

still need to work out some protocol faults
also need to fix system timing problems