revised HW2 with cosine function to smoothly move the left foot - hubo still rocks side to side and falls after 3-4 sit-ups