S5PV210(TQ210)学习笔记——Nand驱动之HWECC

前几天匆忙间发了一篇关于S5PV210的8位HWECC驱动的文章，但是后来发现存在严重的Bug，就将原来那篇文章删除了，这里先说声抱歉，但是，HWECC能有效的节省CPU占用量，我仔细调试了S5PV210的HWECC部分，现在刚调好1位的HWECC，为了表示误发原来那篇文章的歉意，现在将代码放在这里，与大家分享：

1. #include
2. #include
3. #include
4. #include
5. #include
6. #include
7. #include
8. #include
10. #defineNFCONT_MECCLOCK(1<7)
11. #defineNFCONT_SECCLOCK(1<6)
12. #defineNFCONT_INITMECC(1<5)
13. #defineNFCONT_INITSECC(1<4)
14. #defineNFCONT_INITECC(NFCONT_INITMECC|NFCONT_INITSECC)
16. structs5p_nand_regs{
17. unsignedlongnfconf;
18. unsignedlongnfcont;
19. unsignedlongnfcmmd;
20. unsignedlongnfaddr;
21. unsignedlongnfdata;
22. unsignedlongnfmeccd0;
23. unsignedlongnfmeccd1;
24. unsignedlongnfseccd;
25. unsignedlongnfsblk;
26. unsignedlongnfeblk;
27. unsignedlongnfstat;
28. unsignedlongnfeccerr0;
29. unsignedlongnfeccerr1;
30. unsignedlongnfmecc0;
31. unsignedlongnfmecc1;
32. unsignedlongnfsecc;
33. unsignedlongnfmlcbitpt;
34. };
36. staticvolatilestructs5p_nand_regs*s5p_nand_regs;
37. staticstructnand_chip*nand_chip;
38. staticstructmtd_info*s5p_mtd_info;
39. staticstructclk*s5p_nand_clk;
40. staticinteccmode;
42. staticstructnand_ecclayouts5p_nand_oob_64={
43. .eccbytes=16,
44. .eccpos={
45. 40,41,42,43,44,45,46,47,
46. 48,49,50,51,52,53,54,55
47. },
48. .oobfree={
49. {
50. .offset=2,
51. .length=38
52. }
53. }
54. };
56. staticstructmtd_partitions5p_nand_partions[]={
57. [0]={
58. .name="bootloader",
59. .offset=0,
60. .size=SZ_1M,
61. },
63. [1]={
64. .name="kernel",
65. .offset=MTDPART_OFS_APPEND,
66. .size=5*SZ_1M,
67. },
69. [2]={
70. .name="rootfs",
71. .offset=MTDPART_OFS_APPEND,
72. .size=MTDPART_SIZ_FULL,
73. },
74. };
76. staticvoids5p_nand_cmd_ctrl(structmtd_info*mtd,intcmd,unsignedintctrl)
77. {
78. if(ctrl&NAND_CTRL_CHANGE){
79. if(ctrl&NAND_NCE){
80. if(cmd!=NAND_CMD_NONE){
81. s5p_nand_regs->nfcont&=~(1<1);
82. }
83. }else{
84. s5p_nand_regs->nfcont|=(1<1);
85. }
86. }
88. if(cmd!=NAND_CMD_NONE){
89. if(ctrl&NAND_CLE)
90. s5p_nand_regs->nfcmmd=cmd;
91. elseif(ctrl&NAND_ALE)
92. s5p_nand_regs->nfaddr=cmd;
93. }
94. }
96. staticints5p_nand_ready(structmtd_info*mtd){
97. return(s5p_nand_regs->nfstat&0x1);
98. }
100. staticvoids5p_ecc_hwctl(structmtd_info*mtd,intmode){
102. eccmode=mode;
104. s5p_nand_regs->nfconf&=~(0x3<23);
106. /*InitmainECC&unlock*/
107. s5p_nand_regs->nfcont|=NFCONT_INITMECC;
108. s5p_nand_regs->nfcont&=~NFCONT_MECCLOCK;
109. }
111. staticints5p_ecc_calculate(structmtd_info*mtd,constuint8_t*dat,
112. uint8_t*ecc_code){
114. unsignedlongnfmecc0=s5p_nand_regs->nfmecc0;
116. /*Lock*/
117. s5p_nand_regs->nfcont|=NFCONT_MECCLOCK;
119. ecc_code[0]=(nfmecc0)&0xff;
120. ecc_code[1]=(nfmecc0>>8)&0xff;
121. ecc_code[2]=(nfmecc0>>16)&0xff;
122. ecc_code[3]=(nfmecc0>>24)&0xff;
124. return0;
125. }
127. staticints5p_ecc_correct(structmtd_info*mtd,uint8_t*dat,uint8_t*read_ecc,uint8_t*calc_ecc){
128. unsignednfmeccd0,nfmeccd1;
129. unsignedlongnfeccerr0;
131. nfmeccd0=(read_ecc[1]<16)|read_ecc[0];
132. nfmeccd1=(read_ecc[3]<16)|read_ecc[2];
134. s5p_nand_regs->nfmeccd0=nfmeccd0;
135. s5p_nand_regs->nfmeccd1=nfmeccd1;
137. nfeccerr0=s5p_nand_regs->nfeccerr0;
139. switch(nfeccerr0&0x3){
140. case0:
141. return0;
142. case1:
143. printk("s5p-nand:detectedonebiterror");
144. dat[(nfeccerr0>>7)&0x7ff]^=1<((nfeccerr0>>4)&0x3);
145. return1;
146. case2:
147. case3:
148. printk("s5p-nand:detecteduncorrectederror");
149. return3;
151. default:
152. return-EIO;
153. }
154. }
156. staticints5p_nand_read_page(structmtd_info*mtd,structnand_chip*chip,
157. uint8_t*buf,intoob_required,intpage)
158. {
159. inti,stat,eccsize=chip->ecc.size;
160. inteccbytes=chip->ecc.bytes;
161. inteccsteps=chip->ecc.steps;
162. intsecc_start=mtd->oobsize-eccbytes;
163. intcol=0;
164. uint8_t*p=buf;
165. uint32_t*mecc_pos=chip->ecc.layout->eccpos;
166. uint8_t*ecc_calc=chip->buffers->ecccalc;
168. col=mtd->writesize;
169. chip->cmdfunc(mtd,NAND_CMD_RNDOUT,col,-1);
171. /*sparearea*/
172. chip->ecc.hwctl(mtd,NAND_ECC_READ);
173. chip->read_buf(mtd,chip->oob_poi,secc_start);
174. chip->ecc.calculate(mtd,p,&ecc_calc[chip->ecc.total]);
175. chip->read_buf(mtd,chip->oob_poi+secc_start,eccbytes);
177. col=0;
179. /*mainarea*/
180. for(i=0;eccsteps;eccsteps--,i+=eccbytes,p+=eccsize){
181. chip->cmdfunc(mtd,NAND_CMD_RNDOUT,col,-1);
182. chip->ecc.hwctl(mtd,NAND_ECC_READ);
183. chip->read_buf(mtd,p,eccsize);
184. chip->ecc.calculate(mtd,p,&ecc_calc[i]);
186. stat=chip->ecc.correct(mtd,p,chip->stat=chip