added IR and sonar sensor blocks, fixed some issues