added senseWorld.m, reformatted matlabcontrol.m
added senseWorld reformatted controller