fixed vxworks problems and robot drive issue (needs cleaning)