diff --git a/B15F.elf b/B15F.elf
index 8a2740a..25d6b34 100644
Binary files a/B15F.elf and b/B15F.elf differ
diff --git a/B15F.hex b/B15F.hex
index a5a3eae..af2f1a1 100644
--- a/B15F.hex
+++ b/B15F.hex
@@ -1,198 +1,192 @@
-:100000000C945F000C9489000C9489000C94890076
-:100010000C9489000C9489000C9489000C9489003C
-:100020000C9489000C9489000C9489000C9489002C
-:100030000C9489000C9489000C9489000C9489001C
-:100040000C9489000C9489000C9489000C9489000C
-:100050000C9489000C9489000C9489000C948900FC
-:100060000C9489000C9489000C9489000C948900EC
-:100070000C9489000C9489000C9489000C948900DC
-:100080000C9489000C9489000C948900F800FB0002
-:10009000FE00EF000101040107010A010D0110013A
-:1000A000F5001301D505D205CF058C05CC05C90592
-:1000B000C605C305C005BD05BA05D805DB05112475
-:1000C0001FBECFEFD0E4DEBFCDBF11E0A0E0B1E0B6
-:1000D000EAE1FCE000E00BBF02C007900D92A23203
-:1000E000B107D9F721E0A2E2B1E001C01D92A4332B
-:1000F000B207E1F710E0CFE5D0E004C02197FE01A0
-:100100000E940206CE35D107C9F70E9475050C94EE
-:100110000B060C94000083E391E00E94170160E05D
-:1001200080E391E00E945A016FEF80E391E00E942A
-:100130007B0160E08DE291E00E945A016FEF8DE259
-:1001400091E00E947B016FEF8AE291E00E947B01C7
-:1001500083E291E00E94520282E291E00E944A030F
-:10016000789484B7877F84BF109260000FB6F894AC
-:10017000A895809160008861809360001092600073
-:100180000FBE0895CF930FB6F894A89580916000A4
-:10019000886180936000109260000FBE6FEF8DE267
-:1001A00091E00E949C0182E291E00E94F303C82F3B
-:1001B00060E08DE291E00E949C0198E088E10FB63A
-:1001C000F894A895809360000FBE90936000A89566
-:1001D0008C2F90E0FC013197EC30F10510F0CF91BD
-:1001E0000895EA5BFF4F0C940206CF910C94010531
-:1001F000CF910C947A04CF910C948B04CF910C94F2
-:10020000AA04CF910C94B704CF910C94C504CF915C
-:100210000C94D304CF910C94DC04CF910C94E5049E
-:10022000CF910C94F304CF910C940F05089584B1F1
-:10023000806B84B926988AB18C618AB980E58CBDBF
-:1002400081E08DBD8BB1837E8BB95A9A5B9A5C9AA3
-:1002500008958BB1837E8BB98BB160FD10C090E0A7
-:10026000892B8BB98BB161FD10C090E0892B8BB9C4
-:100270008BB162FD10C090E0892B8BB9089594E09A
-:10028000892B8BB98BB161FFF0CF98E0892B8BB9AB
-:100290008BB162FFF0CF90E1892B8BB908956EBDD1
-:1002A0000DB407FEFDCF8EB50895FC017183608308
-:1002B000428308951F93CF93DF93EC01162F6A8139
-:1002C000888199810E94290160E4888199810E9436
-:1002D0004F0160E0888199810E944F01612F8881E0
-:1002E00099810E944F0167E088819981DF91CF91C8
-:1002F0001F910C9429011F93CF93DF93EC01162FCC
-:100300006A81888199810E94290160E488819981AC
-:100310000E944F0161E0888199810E944F01612F05
-:10032000888199810E944F0167E088819981DF91DE
-:10033000CF911F910C9429011F93CF93DF93EC0170
-:10034000162F6A81888199810E94290160E4888141
-:1003500099810E944F0162E1888199810E944F0139
-:10036000612F888199810E944F0167E0888199817E
-:10037000DF91CF911F910C9429011F93CF93DF93AD
-:10038000EC01162F6A81888199810E94290160E41D
-:10039000888199810E944F0163E1888199810E943F
-:1003A0004F01612F888199810E944F0167E0888108
-:1003B0009981DF91CF911F910C9429011F93CF93C5
-:1003C000DF93EC016A81888199810E94290161E4AF
-:1003D000888199810E944F0162E1888199810E9400
-:1003E0004F0160E0888199810E944F01182F67E0DA
-:1003F000888199810E942901812FDF91CF911F91DE
-:1004000008951F93CF93DF93EC016A8188819981CE
-:100410000E94290161E4888199810E944F0163E172
-:10042000888199810E944F0160E0888199810E94B2
-:100430004F01182F67E0888199810E942901812F3F
-:10044000DF91CF911F910895FC01718360834283F6
-:1004500008950F931F93CF93DF93EC018B016A8173
-:10046000888199810E942901B8010024660F771FB5
-:10047000001C660F771F001C672F702D88819981E3
-:100480000E944F01602F660F660F888199810E943C
-:100490004F0167E088819981DF91CF911F910F9182
-:1004A0000C94290110927C0087E880937A000895CB
-:1004B00080917C00807E682B60937C0080917A0024
-:1004C000806480937A0083EA91E00197F1F700C09D
-:1004D000000080917A0086FDFCCF80917800909199
-:1004E000790008950F931F93CF93DF9361E080E32A
-:1004F00091E00E949C01C1E0D0E001E010E02FEF0C
-:1005000084E39CE0215080409040E1F700C000006F
-:10051000B8010C2E01C0660F0A94EAF780E391E05F
-:100520000E949C012196C930D10549F7DF91CF91F6
-:100530001F910F9108950F931F93CF93DF9361E065
-:100540008DE291E00E949C01C1E0D0E001E010E06A
-:100550002FEF84E39CE0215080409040E1F700C001
-:100560000000B8010C2E01C0660F0A94EAF78DE274
-:1005700091E00E949C012196C930D10549F7DF9195
-:10058000CF911F910F910895CF93DF93C0E0D0E0FA
-:10059000BE0187E291E00E94290287E893E101977A
-:1005A000F1F700C000002196C11594E0D90781F74A
-:1005B0002FE78AE196E0215080409040E1F700C0AB
-:1005C000000060E070E087E291E0DF91CF910C9451
-:1005D0002902CF93DF93C0E0D0E0BE0184E291E036
-:1005E0000E94290287E893E10197F1F700C000001B
-:1005F0002196C11594E0D90781F72FE78AE196E0AB
-:10060000215080409040E1F700C0000060E070E0C1
-:1006100084E291E0DF91CF910C9429020FB6F89417
-:10062000A8958091600088618093600010926000BE
-:100630000FBE60E083E291E00E945802BC0187E2B5
-:1006400091E00E94290261E083E291E00E94580259
-:10065000BC0184E291E00E94290280E391E00E94C3
-:100660000102682F80E391E00E949C018AE291E000
-:100670000E940102682F8DE291E00E949C01D9CF77
-:100680000E9472020E949B020E94C4020E94E90220
-:100690000E940E0382E08093C00088E18093C10035
-:1006A00086E08093C2001092C50084E18093C4006C
-:1006B000089502C08091C6008091C00087FDFACFE6
-:1006C00008958091C00085FFFCCF6093C600089517
-:1006D0008091C00085FFFCCF6093C6008091C00070
-:1006E00085FFFCCF7093C60008958091C00085FF00
-:1006F000FCCF4093C6009FEF940F442351F0FB01C1
-:1007000021918091C00085FFFCCF2093C6009150BD
-:10071000B8F708958091C00085FFFCCF4093C600D4
-:100720005FEF540F442309F45CC0FB0120E041E972
-:10073000DF0190818091C00085FFFCCF9093C600BF
-:1007400031969C91822F892780FD842790E0959592
-:100750008795282F80FF02C0242F2827822F90E022
-:1007600095958795282F80FF02C0242F282730E0F9
-:1007700035952795822F20FF02C0842F822790E095
-:1007800095958795282F80FF02C0242F282730E0D9
-:1007900035952795822F20FF02C0842F822790E075
-:1007A00095958795282F80FF02C0242F282730E0B9
-:1007B00035952795822F20FF02C0842F8227282F6E
-:1007C0002695515008F0B4CF8091C00085FFFCCF32
-:1007D0002093C6008091C00087FFFCCF8091C600A7
-:1007E000089520E0F1CF8091C00087FFFCCF809179
-:1007F000C60008958091C00087FFFCCF2091C600FD
-:1008000030E09091C00097FFFCCF8091C600A90115
-:10081000582BCA010895242F30E08091C00087FF33
-:10082000FCCFE091C60040E090E051E9620F731FF9
-:100830008091C00087FFFCCFF091C6008F2F8927E1
-:1008400080FD852790E095958795282F80FF02C031
-:10085000252F2827822F90E095958795282F80FFB8
-:1008600002C0252F282730E035952795822F20FFBD
-:1008700002C0852F822790E095958795282F80FFCD
-:1008800002C0252F282730E035952795822F20FF9D
-:1008900002C0852F822790E095958795282F80FFAD
-:1008A00002C0252F282730E035952795822F20FF7D
-:1008B00002C0852F8227982F96954E17B0F04F5F74
-:1008C000E41708F0B5CF911108C08091C00085FFF2
-:1008D000FCCF8FEF8093C60008958091C00085FF04
-:1008E000FCCF8EEF8093C6000895DB01A40FB11DED
-:1008F000FC93E5CFCF9382E291E00E94F303C82FEF
-:100900006FEF82E291E00E9461036C2F82E291E03E
-:10091000CF910C94610363E082E291E00E94610355
-:100920004CE065E171E082E291E00E94750349E0EC
-:100930006CE071E082E291E00E9475034CE060E0BF
-:1009400071E082E291E00E9475036FEF82E291E034
-:100950000C94610382E291E00E94FA03BC01660FED
-:10096000771F680F791F82E291E00C94680382E29E
-:1009700091E00E94F303682F80E391E00E949C01C4
-:100980006FEF82E291E00C94610382E291E00E94B9
-:10099000F303682F8DE291E00E949C016FEF82E2E9
-:1009A00091E00C94610380E391E00E940102682FC2
-:1009B00082E291E00C9461038DE291E00E940102D9
-:1009C000682F82E291E00C94610382E291E00E9440
-:1009D000FA03BC0187E291E00E9429026FEF82E2F4
-:1009E00091E00C94610382E291E00E94FA03BC0161
-:1009F00084E291E00E9429026FEF82E291E00C9480
-:100A0000610382E291E00E94F303682F83E291E0A8
-:100A10000E945802BC0182E291E00C9468038F921C
-:100A20009F92AF92BF92CF92DF92EF92FF920F937D
-:100A30001F93CF93DF9382E291E00E94F303882E0D
-:100A400082E291E00E94F303982E82E291E00E94FC
-:100A5000FA03EC0182E291E00E94FA035C0182E277
-:100A600091E00E94FA038C016FEF82E291E00E9414
-:100A70006103A09E6001A19ED00CB09ED00C1124F9
-:100A8000CC15DD050CF5BE0187E291E00E9429023C
-:100A9000A895682D83E291E00E9458027C01692D9F
-:100AA00083E291E00E9458028C01B70182E291E05A
-:100AB0000E946803B80182E291E00E946803CA0DB7
-:100AC000DB1DCC15DD05FCF26FEF82E291E0DF91DA
-:100AD000CF911F910F91FF90EF90DF90CF90BF903B
-:100AE000AF909F908F900C9461030E948B006FEFEA
-:100AF00080E391E00E949C012FE78AE196E021507B
-:100B000080409040E1F700C0000060E080E391E0A9
-:100B10000E949C0118E1D8E00FB6F894A895809146
-:100B20006000886180936000109260000FBE6FEFDC
-:100B30008DE291E00E949C0182E291E00E94F30329
-:100B4000C82F60E08DE291E00E949C010FB6F894FE
-:100B5000A895109360000FBED0936000A8958C2FCD
-:100B600090E0FC013197EC30F105B0F6EE5AFF4F02
-:100B70000C9402060E940105CFCF0E94F304CCCF53
-:100B80000E94E504C9CF0E94DC04C6CF0E94D304B2
-:100B9000C3CF0E94C504C0CF0E94B704BDCF0E943E
-:100BA000AA04BACF0E948B04B7CF0E947A04B4CFB4
-:100BB0000E940F05B1CF83E391E00E94160142E04D
-:100BC00063E371E080E391E00E94550143E063E359
-:100BD00071E08DE291E00E94550145E063E371E030
-:100BE0008AE291E00E94550140E063E371E087E210
-:100BF00091E00E94240241E063E371E084E291E02D
-:100C00000C942402EE0FFF1F0024001C0BBE079063
-:0A0C1000F691E02D0994F894FFCF4F
-:100C1A00626F617264696E666F2E680031333A34AE
-:100C2A00303A3131004D6172203239203230313957
-:020C3A000000B8
+:100000000C9453000C947D000C947D000C947D00A6
+:100010000C947D000C947D000C947D000C947D006C
+:100020000C947D000C947D000C947D000C947D005C
+:100030000C947D000C947D000C947D000C947D004C
+:100040000C947D000C947D000C947D000C947D003C
+:100050000C947D000C947D000C947D000C947D002C
+:100060000C947D000C947D000C947D000C947D001C
+:100070000C947D000C947D000C947D000C947D000C
+:100080000C947D000C947D000C947D00EC00EF003E
+:10009000F200E300F500F800FB00FE00010104019E
+:1000A000E9000701AA0511241FBECFEFD0E4DEBF8F
+:1000B000CDBF11E0A0E0B1E0E8EBFBE000E00BBF5A
+:1000C00002C007900D92A232B107D9F721E0A2E257
+:1000D000B1E001C01D92A433B207E1F710E0C3E51F
+:1000E000D0E004C02197FE010E94D105C235D1079E
+:1000F000C9F70E947A050C94DA050C94000083E39A
+:1001000091E00E940B0160E080E391E00E944E01CB
+:100110006FEF80E391E00E946F0160E08DE291E07B
+:100120000E944E016FEF8DE291E00E946F016FEF30
+:100130008AE291E00E946F0183E291E00E94460210
+:1001400082E291E00E943E03789484B7877F84BF67
+:10015000109260000FB6F894A895809160008861B5
+:1001600080936000109260000FBE0895CF930FB689
+:10017000F894A89580916000886180936000109247
+:1001800060000FBE6FEF8DE291E00E94900182E26D
+:1001900091E00E94EC03C82F60E08DE291E00E94A4
+:1001A000900198E088E10FB6F894A89580936000DC
+:1001B0000FBE90936000A8958C2F90E0FC013197C2
+:1001C000EC30F10510F0CF910895EA5BFF4F0C94ED
+:1001D000D105CF910C940605CF910C947F04CF915B
+:1001E0000C949004CF910C94AF04CF910C94BC0468
+:1001F000CF910C94CA04CF910C94D804CF910C9455
+:10020000E104CF910C94EA04CF910C94F804CF91BF
+:100210000C941405089584B1806B84B926988AB132
+:100220008C618AB980E58CBD81E08DBD8BB1837E08
+:100230008BB95A9A5B9A5C9A08958BB1837E8BB97D
+:100240008BB160FD10C090E0892B8BB98BB161FD43
+:1002500010C090E0892B8BB98BB162FD10C090E08B
+:10026000892B8BB9089594E0892B8BB98BB161FFF1
+:10027000F0CF98E0892B8BB98BB162FFF0CF90E182
+:10028000892B8BB908956EBD0DB407FEFDCF8EB5D9
+:100290000895FC0171836083428308951F93CF9377
+:1002A000DF93EC01162F6A81888199810E941D01DC
+:1002B00060E4888199810E94430160E0888199818E
+:1002C0000E944301612F888199810E94430167E068
+:1002D00088819981DF91CF911F910C941D011F930B
+:1002E000CF93DF93EC01162F6A81888199810E9458
+:1002F0001D0160E4888199810E94430161E0888149
+:1003000099810E944301612F888199810E94430154
+:1003100067E088819981DF91CF911F910C941D0135
+:100320001F93CF93DF93EC01162F6A818881998107
+:100330000E941D0160E4888199810E94430162E16D
+:10034000888199810E944301612F888199810E944F
+:10035000430167E088819981DF91CF911F910C94CF
+:100360001D011F93CF93DF93EC01162F6A818881C3
+:1003700099810E941D0160E4888199810E94430156
+:1003800063E1888199810E944301612F888199816D
+:100390000E94430167E088819981DF91CF911F918D
+:1003A0000C941D011F93CF93DF93EC016A81888128
+:1003B00099810E941D0161E4888199810E94430115
+:1003C00062E1888199810E94430160E0888199817E
+:1003D0000E944301182F67E0888199810E941D01C6
+:1003E000812FDF91CF911F9108951F93CF93DF93BA
+:1003F000EC016A81888199810E941D0161E48881F4
+:1004000099810E94430163E1888199810E9443019F
+:1004100060E0888199810E944301182F67E08881FC
+:1004200099810E941D01812FDF91CF911F91089525
+:10043000FC0171836083428308950F931F93CF93D0
+:10044000DF93EC018B016A81888199810E941D01F3
+:10045000B8010024660F771F001C660F771F001C71
+:10046000672F702D888199810E944301602F660F4C
+:10047000660F888199810E94430167E08881998194
+:10048000DF91CF911F910F910C941D0110927C0070
+:1004900087E880937A00089580917C00807E682BA5
+:1004A00060937C0080917A00806480937A0083EA74
+:1004B00091E00197F1F700C0000080917A0086FD7D
+:1004C000FCCF809178009091790008950F931F934D
+:1004D000CF93DF9361E080E391E00E949001C1E05F
+:1004E000D0E001E010E02FEF84E39CE02150804059
+:1004F0009040E1F700C00000B8010C2E01C0660F6B
+:100500000A94EAF780E391E00E9490012196C930B5
+:10051000D10549F7DF91CF911F910F9108950F9366
+:100520001F93CF93DF9361E08DE291E00E949001F1
+:10053000C1E0D0E001E010E02FEF84E39CE0215027
+:1005400080409040E1F700C00000B8010C2E01C0CF
+:10055000660F0A94EAF78DE291E00E9490012196DD
+:10056000C930D10549F7DF91CF911F910F910895BF
+:10057000CF93DF93C0E0D0E0BE0187E291E00E941C
+:100580001D0287E893E10197F1F700C00000219672
+:10059000C11594E0D90781F72FE78AE196E0215051
+:1005A00080409040E1F700C0000060E070E087E22A
+:1005B00091E0DF91CF910C941D02CF93DF93C0E0C7
+:1005C000D0E0BE0184E291E00E941D0287E893E141
+:1005D0000197F1F700C000002196C11594E0D907FA
+:1005E00081F72FE78AE196E0215080409040E1F7C3
+:1005F00000C0000060E070E084E291E0DF91CF9104
+:100600000C941D020FB6F894A89580916000886143
+:1006100080936000109260000FBE60E083E291E082
+:100620000E944C02BC0187E291E00E941D0261E041
+:1006300083E291E00E944C02BC0184E291E00E94BE
+:100640001D0280E391E00E94F501682F80E391E0B4
+:100650000E9490018AE291E00E94F501682F8DE2EC
+:1006600091E00E949001D9CF0E9466020E948F0201
+:100670000E94B8020E94DD020E94020382E0809381
+:10068000C00088E18093C10086E08093C200109290
+:10069000C50084E18093C40008958091C6008FE76F
+:1006A00092E00197F1F700C000008091C00087FD43
+:1006B000F4CF08958091C00085FFFCCF6093C60001
+:1006C00008958091C00085FFFCCF6093C6008091A3
+:1006D000C00085FFFCCF7093C60008958091C000D4
+:1006E00085FFFCCF4093C6009FEF940F442351F049
+:1006F000FB0121918091C00085FFFCCF2093C600B3
+:100700009150B8F708958091C00085FFFCCF4093C9
+:10071000C6005FEF540F442309F45CC0FB0120E0E6
+:1007200041E9DF0190818091C00085FFFCCF90936B
+:10073000C60031969C91822F892780FD842790E006
+:1007400095958795282F80FF02C0242F2827822F78
+:1007500090E095958795282F80FF02C0242F2827A9
+:1007600030E035952795822F20FF02C0842F822705
+:1007700090E095958795282F80FF02C0242F282789
+:1007800030E035952795822F20FF02C0842F8227E5
+:1007900090E095958795282F80FF02C0242F282769
+:1007A00030E035952795822F20FF02C0842F8227C5
+:1007B000282F2695515008F0B4CF8091C00085FFB6
+:1007C000FCCF2093C6008091C00087FFFCCF8091B2
+:1007D000C600089520E0F1CF8091C00087FFFCCFD4
+:1007E0008091C60008958091C00087FFFCCF2091C2
+:1007F000C60030E09091C00097FFFCCF8091C6000A
+:10080000A901582BCA010895CB0171E99C01240F5D
+:10081000311DA9018091C00087FFFCCFE091C60087
+:10082000E13108F0E0E060E090E08091C00087FFF7
+:10083000FCCFF091C6008F2F892780FD872790E09D
+:1008400095958795282F80FF02C0272F2827822F74
+:1008500090E095958795282F80FF02C0272F2827A5
+:1008600030E035952795822F20FF02C0872F822701
+:1008700090E095958795282F80FF02C0272F282785
+:1008800030E035952795822F20FF02C0872F8227E1
+:1008900090E095958795282F80FF02C0272F282765
+:1008A00030E035952795822F20FF02C0872F8227C1
+:1008B000982F96956E17F0F06F5FE61708F0B5CF9A
+:1008C0008091C600EFE7F2E03197F1F700C0000039
+:1008D0008091C00087FDF4CF992351F02EEF8091D5
+:1008E000C00085FFFCCF2093C600911193CF0895DF
+:1008F0002FEFF5CFDA01A60FB11DFC93DDCFCF931B
+:1009000082E291E00E94EC03C82F6FEF82E291E057
+:100910000E945A036C2F82E291E0CF910C945A030B
+:1009200063E082E291E00E945A034CE065E171E0ED
+:1009300082E291E00E946E0349E06CE071E082E2A5
+:1009400091E00E946E034CE060E071E082E291E091
+:100950000E946E036FEF82E291E00C945A0382E2F0
+:1009600091E00E94F303BC01660F771F680F791FA7
+:1009700082E291E00C94610382E291E00E94EC0338
+:10098000682F80E391E00E9490016FEF82E291E096
+:100990000C945A0382E291E00E94EC03682F8DE2EE
+:1009A00091E00E9490016FEF82E291E00C945A0373
+:1009B00080E391E00E94F501682F82E291E00C94BF
+:1009C0005A038DE291E00E94F501682F82E291E0E6
+:1009D0000C945A0382E291E00E94F303BC0187E287
+:1009E00091E00E941D026FEF82E291E00C945A03A5
+:1009F00082E291E00E94F303BC0184E291E00E9454
+:100A00001D026FEF82E291E00C945A0382E291E0C2
+:100A10000E94EC03682F83E291E00E944C02BC012B
+:100A200082E291E00C9461038F929F92AF92BF9209
+:100A3000CF92DF92EF92FF920F931F93CF93DF93AA
+:100A400082E291E00E94EC03882E82E291E00E9413
+:100A5000EC03982E82E291E00E94F303EC0182E223
+:100A600091E00E94F3035C0182E291E00E94F303B3
+:100A70008C016FEF82E291E00E945A03A09E600118
+:100A8000A19ED00CB09ED00C1124CC15DD050CF528
+:100A9000BE0187E291E00E941D02A895682D83E2C5
+:100AA00091E00E944C027C01692D83E291E00E945A
+:100AB0004C028C01B70182E291E00E946103B8010F
+:100AC00082E291E00E946103CA0DDB1DCC15DD05B9
+:100AD000FCF26FEF82E291E0DF91CF911F910F91D5
+:100AE000FF90EF90DF90CF90BF90AF909F908F904E
+:100AF0000C945A03CF93DF93CDB7DEB760970FB650
+:100B0000F894DEBF0FBECDBF0E947F006FEF80E381
+:100B100091E00E9490012FE78AE196E02150804009
+:100B20009040E1F700C0000060E080E391E00E94A7
+:100B3000900160E011E0160F80E391E00E949001C7
+:100B400040E0BE016F5F7F4F82E291E00E940404AB
+:100B5000612FF0CF83E391E00E940A0142E063E35A
+:100B600071E080E391E00E94490143E063E371E0BA
+:100B70008DE291E00E94490145E063E371E08AE281
+:100B800091E00E94490140E063E371E087E291E077
+:100B90000E94180241E063E371E084E291E00C946A
+:100BA0001802EE0FFF1F0024001C0BBE0790F691E9
+:080BB000E02D0994F894FFCF39
+:100BB800626F617264696E666F2E680030383A3110
+:100BC800363A3531004170722020312032303139C7
+:020BD80000001B
 :00000001FF
diff --git a/main.cpp b/main.cpp
index be8f55f..a1eb489 100644
--- a/main.cpp
+++ b/main.cpp
@@ -108,6 +108,14 @@ int main()
 	_delay_ms(100);
 	beba0.writePortA(0x00);
 
+	uint8_t n = 0;
+	uint8_t block[16];
+	while(1)
+	{
+		beba0.writePortA(n++ & 0xFF);
+		usart.readBlock(&block[0], 0);
+	}
+
 	while(1)
 	{
 		handleRequest();
diff --git a/usart.cpp b/usart.cpp
index 57d8f15..f0b93c7 100644
--- a/usart.cpp
+++ b/usart.cpp
@@ -18,8 +18,12 @@ void USART::init()
 void USART::flush()
 {
 	uint8_t dummy;
-	while (UCSR0A & (1<<RXC0))
+	do
+	{
 		dummy = UDR0;
+		_delay_us((1000000 / BAUDRATE) * 16); // Warte Übertragungszeit von 16 Bit ab
+	}
+	while (UCSR0A & (1<<RXC0));
 
 	if(dummy) // taeusche dummy Verwendung vor
 		return;
@@ -93,30 +97,34 @@ uint16_t USART::readInt()
 void USART::readBlock(uint8_t* ptr, uint8_t offset)
 {
 	ptr += offset;
-	uint8_t crc = 0;
-
-	uint8_t len = readByte();
-	for(uint8_t k = 0; k <= len; k++) // len + 1 Durchgänge (+ crc)
+	uint8_t crc;
+	do
 	{
-		uint8_t next = readByte();
+		crc = 0;
+		uint8_t len = readByte();
+		if(len > MAX_BLOCK_SIZE)
+			len = 0;
 
-		crc ^= next;
-		for (uint8_t i = 0; i < 8; i++)
+		for(uint8_t k = 0; k <= len; k++) // len + 1 Durchgänge (+ crc)
 		{
-			if (crc & 1)
-				crc ^= CRC7_POLY;
-			crc >>= 1;
+			uint8_t next = readByte();
+
+			crc ^= next;
+			for (uint8_t i = 0; i < 8; i++)
+			{
+				if (crc & 1)
+					crc ^= CRC7_POLY;
+				crc >>= 1;
+			}
+
+			if(k < len)
+				ptr[k] = next;
 		}
 
-		if(k < len)
-			ptr[k] = next;
+		
+		flush(); // leere Eingangspuffer
+		
+		writeByte(crc == 0 ? MSG_OK : MSG_FAIL);
 	}
-
-	if(crc == 0)
-	{
-		writeByte(MSG_OK);
-		return;
-	}
-	
-	writeByte(MSG_FAIL);
+	while(crc != 0);
 }
diff --git a/usart.h b/usart.h
index ade6b77..f427f3b 100644
--- a/usart.h
+++ b/usart.h
@@ -7,6 +7,7 @@
 
 constexpr uint32_t BAUDRATE = 115200; // 38400
 constexpr uint8_t  CRC7_POLY = 0x91;
+constexpr uint8_t MAX_BLOCK_SIZE = 16;
 
 class USART
 {