lpar.c 18.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * pSeries_lpar.c
 * Copyright (C) 2001 Todd Inglett, IBM Corporation
 *
 * pSeries LPAR support.
 * 
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 * 
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 * 
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */

22 23
/* Enables debugging of low-level hash table routines - careful! */
#undef DEBUG
L
Linus Torvalds 已提交
24 25 26

#include <linux/kernel.h>
#include <linux/dma-mapping.h>
27
#include <linux/console.h>
L
Linus Torvalds 已提交
28 29 30 31 32 33 34 35 36 37 38 39
#include <asm/processor.h>
#include <asm/mmu.h>
#include <asm/page.h>
#include <asm/pgtable.h>
#include <asm/machdep.h>
#include <asm/abs_addr.h>
#include <asm/mmu_context.h>
#include <asm/iommu.h>
#include <asm/tlbflush.h>
#include <asm/tlb.h>
#include <asm/prom.h>
#include <asm/cputable.h>
D
David Gibson 已提交
40
#include <asm/udbg.h>
P
Paul Mackerras 已提交
41
#include <asm/smp.h>
42
#include <asm/trace.h>
43 44

#include "plpar_wrappers.h"
45
#include "pseries.h"
L
Linus Torvalds 已提交
46 47


48
/* in hvCall.S */
L
Linus Torvalds 已提交
49
EXPORT_SYMBOL(plpar_hcall);
50
EXPORT_SYMBOL(plpar_hcall9);
L
Linus Torvalds 已提交
51
EXPORT_SYMBOL(plpar_hcall_norets);
52

L
Linus Torvalds 已提交
53 54 55
extern void pSeries_find_serial_port(void);


56
static int vtermno;	/* virtual terminal# for udbg  */
L
Linus Torvalds 已提交
57 58

#define __ALIGNED__ __attribute__((__aligned__(sizeof(long))))
59
static void udbg_hvsi_putc(char c)
L
Linus Torvalds 已提交
60 61 62 63 64 65 66 67 68 69
{
	/* packet's seqno isn't used anyways */
	uint8_t packet[] __ALIGNED__ = { 0xff, 5, 0, 0, c };
	int rc;

	if (c == '\n')
		udbg_hvsi_putc('\r');

	do {
		rc = plpar_put_term_char(vtermno, sizeof(packet), packet);
70
	} while (rc == H_BUSY);
L
Linus Torvalds 已提交
71 72 73 74 75 76 77 78 79 80 81 82
}

static long hvsi_udbg_buf_len;
static uint8_t hvsi_udbg_buf[256];

static int udbg_hvsi_getc_poll(void)
{
	unsigned char ch;
	int rc, i;

	if (hvsi_udbg_buf_len == 0) {
		rc = plpar_get_term_char(vtermno, &hvsi_udbg_buf_len, hvsi_udbg_buf);
83
		if (rc != H_SUCCESS || hvsi_udbg_buf[0] != 0xff) {
L
Linus Torvalds 已提交
84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
			/* bad read or non-data packet */
			hvsi_udbg_buf_len = 0;
		} else {
			/* remove the packet header */
			for (i = 4; i < hvsi_udbg_buf_len; i++)
				hvsi_udbg_buf[i-4] = hvsi_udbg_buf[i];
			hvsi_udbg_buf_len -= 4;
		}
	}

	if (hvsi_udbg_buf_len <= 0 || hvsi_udbg_buf_len > 256) {
		/* no data ready */
		hvsi_udbg_buf_len = 0;
		return -1;
	}

	ch = hvsi_udbg_buf[0];
	/* shift remaining data down */
	for (i = 1; i < hvsi_udbg_buf_len; i++) {
		hvsi_udbg_buf[i-1] = hvsi_udbg_buf[i];
	}
	hvsi_udbg_buf_len--;

	return ch;
}

110
static int udbg_hvsi_getc(void)
L
Linus Torvalds 已提交
111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
{
	int ch;
	for (;;) {
		ch = udbg_hvsi_getc_poll();
		if (ch == -1) {
			/* This shouldn't be needed...but... */
			volatile unsigned long delay;
			for (delay=0; delay < 2000000; delay++)
				;
		} else {
			return ch;
		}
	}
}

126
static void udbg_putcLP(char c)
L
Linus Torvalds 已提交
127 128 129 130 131 132 133 134 135 136
{
	char buf[16];
	unsigned long rc;

	if (c == '\n')
		udbg_putcLP('\r');

	buf[0] = c;
	do {
		rc = plpar_put_term_char(vtermno, 1, buf);
137
	} while(rc == H_BUSY);
L
Linus Torvalds 已提交
138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155
}

/* Buffered chars getc */
static long inbuflen;
static long inbuf[2];	/* must be 2 longs */

static int udbg_getc_pollLP(void)
{
	/* The interface is tricky because it may return up to 16 chars.
	 * We save them statically for future calls to udbg_getc().
	 */
	char ch, *buf = (char *)inbuf;
	int i;
	long rc;
	if (inbuflen == 0) {
		/* get some more chars. */
		inbuflen = 0;
		rc = plpar_get_term_char(vtermno, &inbuflen, buf);
156
		if (rc != H_SUCCESS)
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169 170
			inbuflen = 0;	/* otherwise inbuflen is garbage */
	}
	if (inbuflen <= 0 || inbuflen > 16) {
		/* Catch error case as well as other oddities (corruption) */
		inbuflen = 0;
		return -1;
	}
	ch = buf[0];
	for (i = 1; i < inbuflen; i++)	/* shuffle them down. */
		buf[i-1] = buf[i];
	inbuflen--;
	return ch;
}

171
static int udbg_getcLP(void)
L
Linus Torvalds 已提交
172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
{
	int ch;
	for (;;) {
		ch = udbg_getc_pollLP();
		if (ch == -1) {
			/* This shouldn't be needed...but... */
			volatile unsigned long delay;
			for (delay=0; delay < 2000000; delay++)
				;
		} else {
			return ch;
		}
	}
}

/* call this from early_init() for a working debug console on
 * vterm capable LPAR machines
 */
190
void __init udbg_init_debug_lpar(void)
L
Linus Torvalds 已提交
191 192
{
	vtermno = 0;
193 194 195
	udbg_putc = udbg_putcLP;
	udbg_getc = udbg_getcLP;
	udbg_getc_poll = udbg_getc_pollLP;
196 197

	register_early_udbg_console();
L
Linus Torvalds 已提交
198 199 200
}

/* returns 0 if couldn't find or use /chosen/stdout as console */
201
void __init find_udbg_vterm(void)
L
Linus Torvalds 已提交
202 203
{
	struct device_node *stdout_node;
204 205
	const u32 *termno;
	const char *name;
L
Linus Torvalds 已提交
206 207 208

	/* find the boot console from /chosen/stdout */
	if (!of_chosen)
209
		return;
210
	name = of_get_property(of_chosen, "linux,stdout-path", NULL);
L
Linus Torvalds 已提交
211
	if (name == NULL)
212
		return;
L
Linus Torvalds 已提交
213 214
	stdout_node = of_find_node_by_path(name);
	if (!stdout_node)
215
		return;
216
	name = of_get_property(stdout_node, "name", NULL);
L
Linus Torvalds 已提交
217 218 219 220 221
	if (!name) {
		printk(KERN_WARNING "stdout node missing 'name' property!\n");
		goto out;
	}

222 223 224
	/* Check if it's a virtual terminal */
	if (strncmp(name, "vty", 3) != 0)
		goto out;
225
	termno = of_get_property(stdout_node, "reg", NULL);
226 227 228 229
	if (termno == NULL)
		goto out;
	vtermno = termno[0];

230
	if (of_device_is_compatible(stdout_node, "hvterm1")) {
231 232 233
		udbg_putc = udbg_putcLP;
		udbg_getc = udbg_getcLP;
		udbg_getc_poll = udbg_getc_pollLP;
234
		add_preferred_console("hvc", termno[0] & 0xff, NULL);
235
	} else if (of_device_is_compatible(stdout_node, "hvterm-protocol")) {
236 237 238 239
		vtermno = termno[0];
		udbg_putc = udbg_hvsi_putc;
		udbg_getc = udbg_hvsi_getc;
		udbg_getc_poll = udbg_hvsi_getc_poll;
240
		add_preferred_console("hvsi", termno[0] & 0xff, NULL);
L
Linus Torvalds 已提交
241 242 243 244 245 246 247 248
	}
out:
	of_node_put(stdout_node);
}

void vpa_init(int cpu)
{
	int hwcpu = get_hard_smp_processor_id(cpu);
249
	unsigned long addr;
L
Linus Torvalds 已提交
250
	long ret;
251 252
	struct paca_struct *pp;
	struct dtl_entry *dtl;
253 254

	if (cpu_has_feature(CPU_FTR_ALTIVEC))
255
		lppaca_of(cpu).vmxregs_in_use = 1;
256

257
	addr = __pa(&lppaca_of(cpu));
258
	ret = register_vpa(hwcpu, addr);
L
Linus Torvalds 已提交
259

260
	if (ret) {
L
Linus Torvalds 已提交
261 262
		printk(KERN_ERR "WARNING: vpa_init: VPA registration for "
				"cpu %d (hw %d) of area %lx returns %ld\n",
263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
				cpu, hwcpu, addr, ret);
		return;
	}
	/*
	 * PAPR says this feature is SLB-Buffer but firmware never
	 * reports that.  All SPLPAR support SLB shadow buffer.
	 */
	addr = __pa(&slb_shadow[cpu]);
	if (firmware_has_feature(FW_FEATURE_SPLPAR)) {
		ret = register_slb_shadow(hwcpu, addr);
		if (ret)
			printk(KERN_ERR
			       "WARNING: vpa_init: SLB shadow buffer "
			       "registration for cpu %d (hw %d) of area %lx "
			       "returns %ld\n", cpu, hwcpu, addr, ret);
	}
279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297

	/*
	 * Register dispatch trace log, if one has been allocated.
	 */
	pp = &paca[cpu];
	dtl = pp->dispatch_log;
	if (dtl) {
		pp->dtl_ridx = 0;
		pp->dtl_curr = dtl;
		lppaca_of(cpu).dtl_idx = 0;

		/* hypervisor reads buffer length from this field */
		dtl->enqueue_to_dispatch_time = DISPATCH_LOG_BYTES;
		ret = register_dtl(hwcpu, __pa(dtl));
		if (ret)
			pr_warn("DTL registration failed for cpu %d (%ld)\n",
				cpu, ret);
		lppaca_of(cpu).dtl_enable_mask = 2;
	}
L
Linus Torvalds 已提交
298 299
}

300
static long pSeries_lpar_hpte_insert(unsigned long hpte_group,
301 302
 			      unsigned long va, unsigned long pa,
 			      unsigned long rflags, unsigned long vflags,
P
Paul Mackerras 已提交
303
			      int psize, int ssize)
L
Linus Torvalds 已提交
304 305 306 307
{
	unsigned long lpar_rc;
	unsigned long flags;
	unsigned long slot;
308
	unsigned long hpte_v, hpte_r;
L
Linus Torvalds 已提交
309

310
	if (!(vflags & HPTE_V_BOLTED))
311
		pr_devel("hpte_insert(group=%lx, va=%016lx, pa=%016lx, "
312 313
			 "rflags=%lx, vflags=%lx, psize=%d)\n",
			 hpte_group, va, pa, rflags, vflags, psize);
314

P
Paul Mackerras 已提交
315
	hpte_v = hpte_encode_v(va, psize, ssize) | vflags | HPTE_V_VALID;
316 317 318
	hpte_r = hpte_encode_r(pa, psize) | rflags;

	if (!(vflags & HPTE_V_BOLTED))
319
		pr_devel(" hpte_v=%016lx, hpte_r=%016lx\n", hpte_v, hpte_r);
320

L
Linus Torvalds 已提交
321 322 323 324 325 326 327 328
	/* Now fill in the actual HPTE */
	/* Set CEC cookie to 0         */
	/* Zero page = 0               */
	/* I-cache Invalidate = 0      */
	/* I-cache synchronize = 0     */
	/* Exact = 0                   */
	flags = 0;

329
	/* Make pHyp happy */
330
	if ((rflags & _PAGE_NO_CACHE) & !(rflags & _PAGE_WRITETHRU))
331
		hpte_r &= ~_PAGE_COHERENT;
L
Linus Torvalds 已提交
332

333
	lpar_rc = plpar_pte_enter(flags, hpte_group, hpte_v, hpte_r, &slot);
334
	if (unlikely(lpar_rc == H_PTEG_FULL)) {
335
		if (!(vflags & HPTE_V_BOLTED))
336
			pr_devel(" full\n");
L
Linus Torvalds 已提交
337
		return -1;
338
	}
L
Linus Torvalds 已提交
339 340 341 342 343 344

	/*
	 * Since we try and ioremap PHBs we don't own, the pte insert
	 * will fail. However we must catch the failure in hash_page
	 * or we will loop forever, so return -2 in this case.
	 */
345
	if (unlikely(lpar_rc != H_SUCCESS)) {
346
		if (!(vflags & HPTE_V_BOLTED))
347
			pr_devel(" lpar err %lu\n", lpar_rc);
L
Linus Torvalds 已提交
348
		return -2;
349 350
	}
	if (!(vflags & HPTE_V_BOLTED))
351
		pr_devel(" -> slot: %lu\n", slot & 7);
L
Linus Torvalds 已提交
352 353 354 355

	/* Because of iSeries, we have to pass down the secondary
	 * bucket bit here as well
	 */
356
	return (slot & 7) | (!!(vflags & HPTE_V_SECONDARY) << 3);
L
Linus Torvalds 已提交
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375
}

static DEFINE_SPINLOCK(pSeries_lpar_tlbie_lock);

static long pSeries_lpar_hpte_remove(unsigned long hpte_group)
{
	unsigned long slot_offset;
	unsigned long lpar_rc;
	int i;
	unsigned long dummy1, dummy2;

	/* pick a random slot to start at */
	slot_offset = mftb() & 0x7;

	for (i = 0; i < HPTES_PER_GROUP; i++) {

		/* don't remove a bolted entry */
		lpar_rc = plpar_pte_remove(H_ANDCOND, hpte_group + slot_offset,
					   (0x1UL << 4), &dummy1, &dummy2);
376
		if (lpar_rc == H_SUCCESS)
L
Linus Torvalds 已提交
377
			return i;
378
		BUG_ON(lpar_rc != H_NOT_FOUND);
L
Linus Torvalds 已提交
379 380 381 382 383 384 385 386 387 388 389 390

		slot_offset++;
		slot_offset &= 0x7;
	}

	return -1;
}

static void pSeries_lpar_hptab_clear(void)
{
	unsigned long size_bytes = 1UL << ppc64_pft_size;
	unsigned long hpte_count = size_bytes >> 4;
391 392 393 394
	struct {
		unsigned long pteh;
		unsigned long ptel;
	} ptes[4];
395
	long lpar_rc;
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412
	int i, j;

	/* Read in batches of 4,
	 * invalidate only valid entries not in the VRMA
	 * hpte_count will be a multiple of 4
         */
	for (i = 0; i < hpte_count; i += 4) {
		lpar_rc = plpar_pte_read_4_raw(0, i, (void *)ptes);
		if (lpar_rc != H_SUCCESS)
			continue;
		for (j = 0; j < 4; j++){
			if ((ptes[j].pteh & HPTE_V_VRMA_MASK) ==
				HPTE_V_VRMA_MASK)
				continue;
			if (ptes[j].pteh & HPTE_V_VALID)
				plpar_pte_remove_raw(0, i + j, 0,
					&(ptes[j].pteh), &(ptes[j].ptel));
413 414
		}
	}
L
Linus Torvalds 已提交
415 416
}

P
Paul Mackerras 已提交
417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
/*
 * This computes the AVPN and B fields of the first dword of a HPTE,
 * for use when we want to match an existing PTE.  The bottom 7 bits
 * of the returned value are zero.
 */
static inline unsigned long hpte_encode_avpn(unsigned long va, int psize,
					     int ssize)
{
	unsigned long v;

	v = (va >> 23) & ~(mmu_psize_defs[psize].avpnm);
	v <<= HPTE_V_AVPN_SHIFT;
	v |= ((unsigned long) ssize) << HPTE_V_SSIZE_SHIFT;
	return v;
}

L
Linus Torvalds 已提交
433 434 435 436 437 438
/*
 * NOTE: for updatepp ops we are fortunate that the linux "newpp" bits and
 * the low 3 bits of flags happen to line up.  So no transform is needed.
 * We can probably optimize here and assume the high bits of newpp are
 * already zero.  For now I am paranoid.
 */
439 440 441
static long pSeries_lpar_hpte_updatepp(unsigned long slot,
				       unsigned long newpp,
				       unsigned long va,
P
Paul Mackerras 已提交
442
				       int psize, int ssize, int local)
L
Linus Torvalds 已提交
443 444 445
{
	unsigned long lpar_rc;
	unsigned long flags = (newpp & 7) | H_AVPN;
446
	unsigned long want_v;
L
Linus Torvalds 已提交
447

P
Paul Mackerras 已提交
448
	want_v = hpte_encode_avpn(va, psize, ssize);
L
Linus Torvalds 已提交
449

450
	pr_devel("    update: avpnv=%016lx, hash=%016lx, f=%lx, psize: %d ...",
451
		 want_v, slot, flags, psize);
L
Linus Torvalds 已提交
452

P
Paul Mackerras 已提交
453
	lpar_rc = plpar_pte_protect(flags, slot, want_v);
454

455
	if (lpar_rc == H_NOT_FOUND) {
456
		pr_devel("not found !\n");
L
Linus Torvalds 已提交
457
		return -1;
458 459
	}

460
	pr_devel("ok\n");
L
Linus Torvalds 已提交
461

462
	BUG_ON(lpar_rc != H_SUCCESS);
L
Linus Torvalds 已提交
463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480

	return 0;
}

static unsigned long pSeries_lpar_hpte_getword0(unsigned long slot)
{
	unsigned long dword0;
	unsigned long lpar_rc;
	unsigned long dummy_word1;
	unsigned long flags;

	/* Read 1 pte at a time                        */
	/* Do not need RPN to logical page translation */
	/* No cross CEC PFT access                     */
	flags = 0;

	lpar_rc = plpar_pte_read(flags, slot, &dword0, &dummy_word1);

481
	BUG_ON(lpar_rc != H_SUCCESS);
L
Linus Torvalds 已提交
482 483 484 485

	return dword0;
}

P
Paul Mackerras 已提交
486
static long pSeries_lpar_hpte_find(unsigned long va, int psize, int ssize)
L
Linus Torvalds 已提交
487 488
{
	unsigned long hash;
P
Paul Mackerras 已提交
489
	unsigned long i;
L
Linus Torvalds 已提交
490
	long slot;
491
	unsigned long want_v, hpte_v;
L
Linus Torvalds 已提交
492

P
Paul Mackerras 已提交
493 494 495 496 497 498 499 500 501 502 503 504
	hash = hpt_hash(va, mmu_psize_defs[psize].shift, ssize);
	want_v = hpte_encode_avpn(va, psize, ssize);

	/* Bolted entries are always in the primary group */
	slot = (hash & htab_hash_mask) * HPTES_PER_GROUP;
	for (i = 0; i < HPTES_PER_GROUP; i++) {
		hpte_v = pSeries_lpar_hpte_getword0(slot);

		if (HPTE_V_COMPARE(hpte_v, want_v) && (hpte_v & HPTE_V_VALID))
			/* HPTE matches */
			return slot;
		++slot;
L
Linus Torvalds 已提交
505 506 507 508 509 510
	}

	return -1;
} 

static void pSeries_lpar_hpte_updateboltedpp(unsigned long newpp,
511
					     unsigned long ea,
P
Paul Mackerras 已提交
512
					     int psize, int ssize)
L
Linus Torvalds 已提交
513
{
514
	unsigned long lpar_rc, slot, vsid, va, flags;
L
Linus Torvalds 已提交
515

P
Paul Mackerras 已提交
516 517
	vsid = get_kernel_vsid(ea, ssize);
	va = hpt_va(ea, vsid, ssize);
L
Linus Torvalds 已提交
518

P
Paul Mackerras 已提交
519
	slot = pSeries_lpar_hpte_find(va, psize, ssize);
L
Linus Torvalds 已提交
520 521 522 523 524
	BUG_ON(slot == -1);

	flags = newpp & 7;
	lpar_rc = plpar_pte_protect(flags, slot, 0);

525
	BUG_ON(lpar_rc != H_SUCCESS);
L
Linus Torvalds 已提交
526 527 528
}

static void pSeries_lpar_hpte_invalidate(unsigned long slot, unsigned long va,
P
Paul Mackerras 已提交
529
					 int psize, int ssize, int local)
L
Linus Torvalds 已提交
530
{
531
	unsigned long want_v;
L
Linus Torvalds 已提交
532 533 534
	unsigned long lpar_rc;
	unsigned long dummy1, dummy2;

535
	pr_devel("    inval : slot=%lx, va=%016lx, psize: %d, local: %d\n",
536
		 slot, va, psize, local);
L
Linus Torvalds 已提交
537

P
Paul Mackerras 已提交
538 539
	want_v = hpte_encode_avpn(va, psize, ssize);
	lpar_rc = plpar_pte_remove(H_AVPN, slot, want_v, &dummy1, &dummy2);
540
	if (lpar_rc == H_NOT_FOUND)
L
Linus Torvalds 已提交
541 542
		return;

543
	BUG_ON(lpar_rc != H_SUCCESS);
L
Linus Torvalds 已提交
544 545
}

546 547 548 549 550 551 552 553 554 555 556 557 558 559
static void pSeries_lpar_hpte_removebolted(unsigned long ea,
					   int psize, int ssize)
{
	unsigned long slot, vsid, va;

	vsid = get_kernel_vsid(ea, ssize);
	va = hpt_va(ea, vsid, ssize);

	slot = pSeries_lpar_hpte_find(va, psize, ssize);
	BUG_ON(slot == -1);

	pSeries_lpar_hpte_invalidate(slot, va, psize, ssize, 0);
}

560 561 562 563 564 565 566
/* Flag bits for H_BULK_REMOVE */
#define HBR_REQUEST	0x4000000000000000UL
#define HBR_RESPONSE	0x8000000000000000UL
#define HBR_END		0xc000000000000000UL
#define HBR_AVPN	0x0200000000000000UL
#define HBR_ANDCOND	0x0100000000000000UL

L
Linus Torvalds 已提交
567 568 569 570
/*
 * Take a spinlock around flushes to avoid bouncing the hypervisor tlbie
 * lock.
 */
571
static void pSeries_lpar_flush_hash_range(unsigned long number, int local)
L
Linus Torvalds 已提交
572
{
573
	unsigned long i, pix, rc;
574
	unsigned long flags = 0;
L
Linus Torvalds 已提交
575 576
	struct ppc64_tlb_batch *batch = &__get_cpu_var(ppc64_tlb_batch);
	int lock_tlbie = !cpu_has_feature(CPU_FTR_LOCKLESS_TLBIE);
577 578 579 580
	unsigned long param[9];
	unsigned long va;
	unsigned long hash, index, shift, hidx, slot;
	real_pte_t pte;
P
Paul Mackerras 已提交
581
	int psize, ssize;
L
Linus Torvalds 已提交
582 583 584 585

	if (lock_tlbie)
		spin_lock_irqsave(&pSeries_lpar_tlbie_lock, flags);

586
	psize = batch->psize;
P
Paul Mackerras 已提交
587
	ssize = batch->ssize;
588 589 590 591 592
	pix = 0;
	for (i = 0; i < number; i++) {
		va = batch->vaddr[i];
		pte = batch->pte[i];
		pte_iterate_hashed_subpages(pte, psize, va, index, shift) {
P
Paul Mackerras 已提交
593
			hash = hpt_hash(va, shift, ssize);
594 595 596 597 598
			hidx = __rpte_to_hidx(pte, index);
			if (hidx & _PTEIDX_SECONDARY)
				hash = ~hash;
			slot = (hash & htab_hash_mask) * HPTES_PER_GROUP;
			slot += hidx & _PTEIDX_GROUP_IX;
599 600
			if (!firmware_has_feature(FW_FEATURE_BULK_REMOVE)) {
				pSeries_lpar_hpte_invalidate(slot, va, psize,
P
Paul Mackerras 已提交
601
							     ssize, local);
602 603
			} else {
				param[pix] = HBR_REQUEST | HBR_AVPN | slot;
P
Paul Mackerras 已提交
604 605
				param[pix+1] = hpte_encode_avpn(va, psize,
								ssize);
606 607 608
				pix += 2;
				if (pix == 8) {
					rc = plpar_hcall9(H_BULK_REMOVE, param,
609 610 611
						param[0], param[1], param[2],
						param[3], param[4], param[5],
						param[6], param[7]);
612 613 614
					BUG_ON(rc != H_SUCCESS);
					pix = 0;
				}
615 616 617 618 619 620 621 622 623 624
			}
		} pte_iterate_hashed_end();
	}
	if (pix) {
		param[pix] = HBR_END;
		rc = plpar_hcall9(H_BULK_REMOVE, param, param[0], param[1],
				  param[2], param[3], param[4], param[5],
				  param[6], param[7]);
		BUG_ON(rc != H_SUCCESS);
	}
L
Linus Torvalds 已提交
625 626 627 628 629

	if (lock_tlbie)
		spin_unlock_irqrestore(&pSeries_lpar_tlbie_lock, flags);
}

630 631 632 633 634 635 636 637 638 639 640 641
static int __init disable_bulk_remove(char *str)
{
	if (strcmp(str, "off") == 0 &&
	    firmware_has_feature(FW_FEATURE_BULK_REMOVE)) {
			printk(KERN_INFO "Disabling BULK_REMOVE firmware feature");
			powerpc_firmware_features &= ~FW_FEATURE_BULK_REMOVE;
	}
	return 1;
}

__setup("bulk_remove=", disable_bulk_remove);

642
void __init hpte_init_lpar(void)
L
Linus Torvalds 已提交
643 644 645 646 647 648
{
	ppc_md.hpte_invalidate	= pSeries_lpar_hpte_invalidate;
	ppc_md.hpte_updatepp	= pSeries_lpar_hpte_updatepp;
	ppc_md.hpte_updateboltedpp = pSeries_lpar_hpte_updateboltedpp;
	ppc_md.hpte_insert	= pSeries_lpar_hpte_insert;
	ppc_md.hpte_remove	= pSeries_lpar_hpte_remove;
649
	ppc_md.hpte_removebolted = pSeries_lpar_hpte_removebolted;
L
Linus Torvalds 已提交
650 651 652
	ppc_md.flush_hash_range	= pSeries_lpar_flush_hash_range;
	ppc_md.hpte_clear_all   = pSeries_lpar_hptab_clear;
}
653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704

#ifdef CONFIG_PPC_SMLPAR
#define CMO_FREE_HINT_DEFAULT 1
static int cmo_free_hint_flag = CMO_FREE_HINT_DEFAULT;

static int __init cmo_free_hint(char *str)
{
	char *parm;
	parm = strstrip(str);

	if (strcasecmp(parm, "no") == 0 || strcasecmp(parm, "off") == 0) {
		printk(KERN_INFO "cmo_free_hint: CMO free page hinting is not active.\n");
		cmo_free_hint_flag = 0;
		return 1;
	}

	cmo_free_hint_flag = 1;
	printk(KERN_INFO "cmo_free_hint: CMO free page hinting is active.\n");

	if (strcasecmp(parm, "yes") == 0 || strcasecmp(parm, "on") == 0)
		return 1;

	return 0;
}

__setup("cmo_free_hint=", cmo_free_hint);

static void pSeries_set_page_state(struct page *page, int order,
				   unsigned long state)
{
	int i, j;
	unsigned long cmo_page_sz, addr;

	cmo_page_sz = cmo_get_page_size();
	addr = __pa((unsigned long)page_address(page));

	for (i = 0; i < (1 << order); i++, addr += PAGE_SIZE) {
		for (j = 0; j < PAGE_SIZE; j += cmo_page_sz)
			plpar_hcall_norets(H_PAGE_INIT, state, addr + j, 0);
	}
}

void arch_free_page(struct page *page, int order)
{
	if (!cmo_free_hint_flag || !firmware_has_feature(FW_FEATURE_CMO))
		return;

	pSeries_set_page_state(page, order, H_PAGE_SET_UNUSED);
}
EXPORT_SYMBOL(arch_free_page);

#endif
705 706 707 708 709 710 711 712 713 714 715

#ifdef CONFIG_TRACEPOINTS
/*
 * We optimise our hcall path by placing hcall_tracepoint_refcount
 * directly in the TOC so we can check if the hcall tracepoints are
 * enabled via a single load.
 */

/* NB: reg/unreg are called while guarded with the tracepoints_mutex */
extern long hcall_tracepoint_refcount;

716 717 718 719 720 721 722
/* 
 * Since the tracing code might execute hcalls we need to guard against
 * recursion. One example of this are spinlocks calling H_YIELD on
 * shared processor partitions.
 */
static DEFINE_PER_CPU(unsigned int, hcall_trace_depth);

723 724 725 726 727 728 729 730 731 732
void hcall_tracepoint_regfunc(void)
{
	hcall_tracepoint_refcount++;
}

void hcall_tracepoint_unregfunc(void)
{
	hcall_tracepoint_refcount--;
}

733
void __trace_hcall_entry(unsigned long opcode, unsigned long *args)
734
{
735 736 737 738 739 740 741 742 743 744 745
	unsigned long flags;
	unsigned int *depth;

	local_irq_save(flags);

	depth = &__get_cpu_var(hcall_trace_depth);

	if (*depth)
		goto out;

	(*depth)++;
746
	trace_hcall_entry(opcode, args);
747 748 749 750
	(*depth)--;

out:
	local_irq_restore(flags);
751 752
}

753 754
void __trace_hcall_exit(long opcode, unsigned long retval,
			unsigned long *retbuf)
755
{
756 757 758 759 760 761 762 763 764 765 766
	unsigned long flags;
	unsigned int *depth;

	local_irq_save(flags);

	depth = &__get_cpu_var(hcall_trace_depth);

	if (*depth)
		goto out;

	(*depth)++;
767
	trace_hcall_exit(opcode, retval, retbuf);
768 769 770 771
	(*depth)--;

out:
	local_irq_restore(flags);
772 773
}
#endif