## Translate angle/parameter data to xy position
## angle - angle of stick with vertical direction
## bpos  - base position 
## l     - lengh of stick
function [x, y] = xypos(angle, bpos, l)
  x = bpos + l .* sin(angle);
  y = l .* cos(angle);
endfunction
