starting implementation of theta star
first impl of theta star...seems to work fine so far