Fixed some bugs in the filter and fixed resrobotcallback