Added in example dynamixel callback, some new test cases to main file