Det blev en del rader, men är egentligen inte särskilt komplicerat kodmässigt. Slängde ihop några enkla klasser för linjär algebra (finns säkerligen en hel del betydligt effektivare bibliotek att använda, men jag hittade inget som var gratis...). Den klurigaste grejen är att invertera matrisen R, men där hade jag god hjälp av Mathematica
Säg till om det är något som verkar skumt när du har provat!