Updated servo block generator code